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Abstract 

Multivarible  control  laws  are  designed  for  the  Advanced  Fighter  Technology 
Integration  F-16  (AFTI/F-16).  Digital  Proportional  plus  Integral  (PI)  output 
feedback  controllers  are  designed  using  a  method  developed  by  Professor  Brian 
Porter  of  the  University  of  Salford,  England  and  the  computer  aided  design  program 

MATRIX*. 

The  AFTI/F-16  control  inputs  used  for  this  design  are  individually  controlled 
flaperons.  individually  controlled  elevators,  and  engine  thrust.  The  aircraft 
dynamics  are  linearized  about  one  flight  condition  and  are  presented  in  both  a 
state  space  form  and  as  an  autoregressive  difference  equation. 

Both  fixed  gain  and  adaptive  PI  controllers  are  designed  for  a  plant  were  the 
number  of  outputs  are  not  equal  to  the  number  of  inputs  (rectangular  plant). 
Simulations  are  conducted  for  a  healthy  and  a  failed  aircraft  model.  The  failure 
consists  of  reducing  the  left  elevator  effectiveness  by  50 %.  When  the  fixed  gain 
controller  is  used  for  the  flight  control  system,  the  simulation  reveals  the  fact  that 
the  aircraft  failure  causes  the  output  responses  to  diverge.  If  provided  with  a 
‘persistently  exciting  "input,  the  adaptive  controller  prevents  the  aircraft  failure 
simulations  from  diverging  and  going  unstable.  However,  additional  testing  and/or 
tuning  of  the  adaptive  controller  is  required  to  determine  and  enhance  the  stability 
of  the  adaptive  controller. 


MULTIVARIABLE  CONTROL  LAW  DESIGN 
FOR  THE  AFTI/F-16  WITH  A  FAILED 
CONTROL  SURFACE  USING  A 
PARAMETER-ADAPTIVE  CONTROLLER 


I.  Introduction 


1.1  Background 

Adaptive  controls  have  the  capability  of  adapting  to  a  changing  environment 
through  an  internal  process  of  measurement,  evaluation,  and  adjustment.  This 
gives  the  adaptive  system  the  ability  to  determine  the  optimal  gain  settings  of 
flight  control  systems  at  various  flight  conditions  without  requiring  extensive 
ground  or  flight  testing  (1:199). 

A  parameter-adaptive  control  system,  using  recursive  identification  as 
the  adaptation  mechanism,  was  demonstrated  by  Capt  L.A.  Pineiro  (2).  His 
demonstration  investigated  the  tracking  performance  effectiveness  of  parameter- 
adaptive  control  laws  in  a  model-following  mode.  The  parameter-adaptive 
capabilities  were  evaluated  using  linearized  longitudinal  equations  of  motion  of  the 
Advanced  Fighter  Technolgv  Integration  F-16  (AFTI/F-16)  at  a  flight  condition 
of  0.9  Mach  at  20.000ft  mean  sea  level  (MSL)(4).  Use  of  this  adaptive  system 
permitted  tracking  fidelity  to  be  maintained  despite  parameter  deviations.  A 
square  plant  was  used  for  this  design;  that  is.  a  plant  where  the  number  of  inputs 
equal  the  number  of  outputs.  One  of  Capt  Pineiro's  recommendations  was  that 
reconfiguration  strategies  be  investigated. 


The  ability  of  an  aircraft  to  reconfigure  its  flight  control  laws  and  maintain 


stability  after  failure,  or  degradation,  of  a  control  surface  is  an  important  topic 
for  the  Air  Force  (3).  Advanced  aircraft,  such  as  the  AFTI/F-16,  have  enhanced 
combat  effectiveness  due  to  the  use  of  Control  Configured  Vehicle  (CCV) 
capabilities.  This  capability  allows  the  AFTI/F-16  to  perform  unconventional 
maneuvers,  such  as  translation  and  fuselage  pointing  (4).  This  is  possible  because 
the  aircraft  is  equipped  with  additional  control  surfaces,  such  as  canards,  and 
independent  operation  of  the  left  and  right  ailerons  and  elevators.  This  feature 
enables  the  surfaces  which  were  previously  used  only  to  produce  longitudinal 
movements  to  also  produce  lateral  movement,  and  vice  versa.  These  control 
surfaces  can  also  be  used  to  compensate  for  control  surface  failure,  or  damage,  by 
applying  forces  and  moments  required  to  maintain  stability  and  control  (4). 

1.2  Problem 

The  purpose  of  this  thesis  is  first  to  design  both  a  fixed  gain  and  a  parameter- 
adaptive  controller  for  a  plant  where  the  number  of  inputs  does  not  equal  the 
number  of  outputs  (rectangular  plant).  The  second  purpose  is  to  compare  the 
stabilitly  and  time  response  of  these  controllers  with  respect  to  reconfiguration 
control. 

1.3  Summary  of  Current  Knowledge 

This  section  presents  background  information  on  Porter's  modern  control  law 
design  technique,  adaptive  systems,  and  reconfigurable  aircraft  flight  controls. 

1.3.1  Porter  Method.  Control  laws  can  be  categorized  as  conventional  or 
modern.  Conventional  control  law  methodology  was  developed  up  to  and  including 


the  late  1950s.  and  the  control  law  methodology  developed  since  then  is  referred  to 


as  modern  control  laws  (5:12).  D'Azzo  and  Houpis  (5:525)  state  that  conventional 
control  laws  can  be  effectively  used  for  single-input  single-output  systems,  but  are 
difficult  to  use  for  multiple-input  multiple  output  (MIMO)  systems.  Because  of 
this  difficulty,  modern  control  law’s  are  used  for  some  MIMO  systems  (5:12).  Two 
major  categories  of  modern  control  laws  are  optimal  control  and  eigenstructure 
assignment.  Under  eigenstructure  assignment  there  are  techniques  of  state 
feedback  and  output  feedback.  The  remainder  of  this  section  review’s  an  output 
feedback  multivariable  design  technique  developed  by  Professor  Brian  Porter  of  the 
University  of  Salford.  England  (6). 

The  Porter  technique  uses  output  feedback  with  a  high-gain  error  actuated 
controller.  Output  feedback  is  desirable  over  state  feedback  since  it  is  not  usually 
possible  to  sense,  or  reconstruct,  the  required  states  for  a  state  feedback  system 
(7).  High-gain  forces  the  closed-loop  response  of  the  system  to  approach  an 
asymptotic  structure  with  two  distinct  modes.  These  are  referred  to  as  fast 
and  slow  modes  by  Porter  and  Manganas  (8).  For  a  system  in  which  the  first 
Markov  parameter  (explained  in  Section  3.3)  has  full  rank,  the  slow  mode  is 
characterized  as  uncontrollable  and  unobservable:  therefore,  the  response  of  the 
closed-loop  system  is  dominated  by  the  fast  modes.  As  implied  by  its  name,  the 


fast  mode  gives  the  system  a  fast  tracking  capability  as  the  gain  increases.  The 
main  objective  of  the  design  is  to  determine  the  controller  gain  values  that  produce 
satisfactory  responses  and  simultaneously  decouples  the  system.  These  gains  are 


normally  fixed  and  are  valid  only  for  the  plant  conditions  originally  designed,  plus 
some  small  plant  deviation.  However,  if  there  are  large  plant  parameter  changes, 
such  as  surface  failures,  then  new  gain  values  must  be  inserted  into  the  controller. 
Jones  and  Porter  (9)  state  that  this  reinsertion  is  required  due  to  the  degradation 
in  the  closed-loop  response.  An  alternate  scheme  is  to  use  an  adaptive  controller 
that  automatically  changes  these  values  as  the  plant  parameters  change. 

1.3.2  Adaptive  Controls.  Research  into  adaptive  control  was  motivated  in 
the  1950s  by  high  performance  aircraft  requirements  (10:471).  Astrom  stated 
that  the  constant  gain  linear  systems  which  work  satisfactorily  in  one  operating 
condition  may  not  work  well  in  a  different  operating  condition  (10:471).  In  fact, 
according  to  Blakelock,  the  aircraft  transfer  function  varies  as  the  airspeed  and 
altitude  change(l:199).  Due  to  this  constant  gain  limitation,  a  system  that 
works  over  a  wider  range  of  operating  points  was  required.  This  requirement 
led  to  the  design  of  adaptive  flight  controls.  There  are  several  types  of  adaptive 
controllers  (regulators).  Three  of  the  simplest  controllers  are  gain  scheduling, 
model  reference,  and  self-tuning  controllers  (10:471).  The  remainder  of  this  section 
briefly  discusses  gain  scheduling  and  model  reference  controllers.  Self-tuning 
regulators  (STR)  are  then  discussed  in  greater  detail. 

In  gain  scheduling,  a  variable  w’hich  gives  an  indication  of  the  change  in  the 
plant  parameters  is  used  to  modify  the  system  gains.  In  flight  control  systems  two 
variables  are  often  used  to  schedule  the  gains.  Mach  number  and  dynamic  pressure. 
A  drawback  to  gain  scheduling  is  that  it  is  an  open-loop  solution  and  may  require 


fine  tuning  during  both  ground  and  flight  testing  (10:472;  1:199).  The  ability  to 
quickly  change  the  gains  of  the  system  is  an  advantage  of  gain  scheduling. 

Model  reference  controllers  use  a  reference  model  plant  and  compare  the 
r  'sponse  of  the  plant  to  the  reference  model.  Any  difference  between  the  reference 
model  and  the  plant  are  nulled  out;  therefore,  the  controller  attempts  to  force  the 
process  to  behave  like  the  reference  model.  Isermann  state  that  the  problem  with 
this  scheme  is  that  the  reference  model  may  not  be  the  optimal  model  at  the  given 
time  (11:514).  Quick  adaptation  and  the  ability  to  use  nonlinear  stability  theories 
are  advantages  of  model  reference  controllers  (11:514). 

The  self-tuning  regulator,  shown  in  Figure  1-1.  consists  of  an  inner  loop 
between  the  process  and  the  regulator  and  an  outer  loop  which  controls  the 
regulator  parameters.  Also,  the  self-tuning  regulator  contains  a  recursive 
parameter  estimator.  Many  parameter  estimation  schemes  have  been  used, 
including:  recursive  least  squares  (RLS).  recursive  maximum  likelihood,  stochastic 
approximation,  and  others  (11:515).  An  important  requirement  when  using  these 
schemes  is  for  the  input  signal  to  the  plant  to  exhibit  a  ” persistently  exciting” 
characteristic  in  order  to  prevent  poor  parameter  estimations  (12:598). 

Pineiro  (2)  uses  a  modified  RLS  algorithm  developed  by  Hagglund  (13).  This 
algorithm  discounts  old  data  based  on  the  information  obtained  from  the  new  data. 
Th  is  allows  updates  of  the  parameter  estimates  only  as  new  information  is  obtained 


ADAPTATION  MECHANISM 


Fig.  1-1  Self-Tuning  Regulator 
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1.3.3  Reconfigurable  Flight  Controls.  The  design  of  fixed  gain  reconfigurable 
flight  control  laws  has  been  demonstrated  for  the  AFTI/F-16.  Specifically, 
in  his  masters  thesis  (4),  Eslinger  designed  controllers  for  both  a  model  of  a 
healthy  AFTI/F-16  with  all  the  control  surfaces  operational  and  for  a  model  of  an 
AFTI/F-16  with  a  failed  right  horizontal  tail.  Porter  and  Frigg  also  demonstrated 
the  effective  use  of  an  adaptive  controller  with  PI  control  laws  in  a  reconfigurable 
scheme  (14).  They  demonstrated  the  successful  application  of  an  adaptive  system 
in  a  multivariable  plant  that  had  an  actuator  failure. 

1.4  Assumptions 

For  this  thesis  design,  the  linearized  equations  of  motion  for  the  AFTI/F-16  are 
used.  The  following  basic  assumptions  are  made  (1:  4;  15): 

1)  The  aircraft  has  constant  mass  and  is  a  rigid  body. 

2)  The  earth's  surface  is  an  inertial  frame  of  reference. 

3)  The  atmosphere  is  assumed  fixed  with  respect  to  the  earth. 

4)  Aerodynamics  are  constant  for  a  given  Mach  number  and  altitude. 

5)  Linearization  about  a  nominal  point  is  acceptable. 

1.5  Limitations 

In  order  to  limit  the  scope  of  the  thesis  to  a  workable  level,  the  effects  of 


noise,  delays,  or  sensor  dynamics  were  not  addressed.  Also,  due  to  problems 
encountered  during  this  research,  it  is  not  possible  to  add  the  actuator  dynamics 
to  this  simulation.  This  problem  is  discussed  in  Chapter  4.  Section  4.4.2. 


1.6  Approach 

To  accomplish  the  purpose  of  this  thesis,  the  objectives  listed  below  were 
accomplished. 

OBJECTIVE  1.  Design  a  Multiple- Input  Multiple-Output  (MIMO)  fixed 
gain  control  law  for  the  AFTI/F-16  using  MATRIX *  (24)  for  implementation  and 
simulation. 

The  control  laws  for  a  healthy  aircraft  are  first  designed  using  Porter's  high- 
gain  error-actuated  controller  method  and  the  computer-aided  control  design 
program  called  MATRIX*.  A  linear  model  of  the  AFTI/F-16  is  used.  The 
aircraft  control  surfaces  consist  of  two  individually  controlled  flaperons,  and  two 
individually  controlled  horizontal  tails.  In  addition,  engine  thrust  is  used  as  a 
control  input.  The  controlled  output  variables  are  flight-path  angle,  sideslip  angle, 
and  yaw  rate.  A  standard  day  flight  condition  of  0.9  Mach  at  20000  feet  MSL 
is  used.  The  design  for  a  healthy  aircraft  is  then  evaluated  with  a  failed  control 
surface  model.  The  failed  model  consisted  of  a  failed  left  horizontal  tail.  This 
failure  is  a  partial  failure,  where  the  effectiveness  of  the  control  surface  is  reduced 
to  fifty  percent.  Originally,  additional  surface  failures  and  total  surface  failures 
were  planned.  However,  since  the  adaptive  controller  (see  Objective  2)  did  not 
work  properly,  the  addition  failure  data  was  not  required. 

OBJECTIVE  2.  Design  a  MIMO  parameter-adaptive  controller  for  the  AFIT 
F-16  on  MATRIX*  and  compare  this  design  to  the  fixed  gain  design. 

This  is  accomplished  by  replacing  the  fixed  parameter  portion  of  the  MIMO 


design  (Objective  1)  with  a  parameter-adaptive  design  for  the  AFIT  F-16  on 
MATRIX  a-.  Data  are  obtained  for  the  same  flight  condition  and  failure  that  are 
used  during  the  fixed  gain  evaluation. 

1.7  Summary 

This  chapter  presents  background  information  on  adaptive  systems  and  their 
use.  Porter's  modern  control  law  design  technique  and  its  use  in  MIMO  systems 
are  also  discussed.  In  addition,  the  purpose  and  specific  objectives  of  this  thesis 
are  introduced. 

1.8  Overview 

This  thesis  contains  five  chapters  and  five  appendices.  Chapter  2  contains  a 
description  of  the  AFTI/F-16.  Detailed  multivariable  control  law  theory  and  a 
brief  description  of  adaptive  control  law  theory  is  then  presented  in  Chapter  3. 
The  simulation  procedures  and  results  are  contained  in  Chapter  4.  Conclusions 


and  recommendations  are  presented  in  Chapter  5. 


II.  Aircraft  Description  and  Models 

2.1  Introduction 

This  section  presents  a  brief  description  of  the  AFTI/F-16  aircraft.  Then  the 
aircraft  models  used  for  this  thesis  are  presented.  These  models  consist  of  both 
the  healthy  and  failed  models  for  the  AFTI/F-16.  Information  for  this  chapter  is 
obtained  mainly  from  References  4  and  18. 

2.2  Aircraft  Description 

The  AFTI/F-16  is  shown  in  Figure  2-1.  This  aircraft  is  a  modified  F-16A 
and  is  used  as  a  testbed  for  the  evaluation  of  new  technologies.  This  aircraft  is 
modified  with  a  redundant  digital  fly-by-wire  flight  control  system,  independent 
operation  of  the  trailing  edge  flaps  (flaperons).  independent  operation  of  the 
horizontal  tail  halves,  and  the  addition  of  two  vertical  canards.  The  unagumented 
F-16A  is  statically  unstable  in  the  longitudinal  axis  in  subsonic  flight.  The  aircraft 
was  designed  to  allow  it  to  attain  higher  load  factors  and  to  reduce  its  drag.  In 
addition,  the  Dutch  roll  is  lightly  damped  in  subsonic  flight.  Therefore,  the 
primary  function  of  the  flight  control  system  is  to  stabilize  the  longitudinal  axis 
and  increase  the  Dutch  roll  damping. 

The  modifications  performed  on  the  AFTI/F-16  allow  it  to  perform  both 

conventional  and  unconventional  maneuvers.  The  conventional  maneuvers  consist 
of  coordinated  turns,  rolling  laterally,  and  longitudinal  pitching.  Operation  of  the 
canards,  the  ability  to  operate  the  flap  independently,  and  independent  operation 


of  the  tail  surfaces  give  the  AFTI/F-16  the  ability  to  decouple  the  aircraft 
force  and  moment  equations.  This  decoupling  allows  the  aircraft  to  perform 
unconventional  maneuvers  such  as:  pitch-pointing,  lateral  and  longitudinal 
translation,  and  yaw  pointing. 

The  AFTI/F-16  control  surfaces  are  shown  in  Figure  2-2.  Both  the  horizontal 

tail  and  flaperons  serve  a  dual  function.  The  horizontal  tail  can  be  either  deflected 

symmetrically  as  the  primary  pitch  control  surface  of  the  aircraft  or  deflected 

asymmetrically  to  augment  lateral  rolling.  The  flaperons  can  be  either  deflected 

symmetrically  to  produce  lift  (flaps)  or  deflected  asymmetrically  as  the  primary 

roll  control  surfaces.  The  canards  have  the  capability  to  be  used  independently  in 

a  snowplow  configuration  as  a  speed  brake  or  as  surfaces  which  produce  sideforces. 

For  this  thesis,  only  the  flaperons  and  horizontal  tails  (elevators)  are  used  as 

control  surfaces.  The  control  surfaces  deflections  are  defined  as  follows: 

6DT  =  Differential  flaperon  deflection 
^DT  =  Differential  horizontal  tail  deflection 
6ji  =  Left  flaperon  deflection 

6fr  =  Right  flaperon  deflection 
6ei  =  Left  horizontal  tail  deflection 
6er  =  Right  horizontal  tail  deflection 

The  AFTI/F-16  flight  control  system  is  divided  into  four  major  configurations. 
Each  of  these  configurations  is  used  to  support  a  primary  mission  task  for  the 
AFTI/F-16. 

The  first  flight  control  configuration,  called  the  normal  mode,  is  used  during 
the  take-off,  cruising,  air-refueling  and  landing  portion  of  the  mission.  The  second 


bDT  is  defined  as:  btr  down,  bt\  up 
bDT  is  defined  as:  bfT  down,  bfi  up 


Fig.  2-2  AFTI/F-16  Control  Surfaces 
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configuration  (air-to-air  gunnery  mode)  is  used  during  tasks  that  require 


precise  pointing  of  the  aircraft,  such  as  target  tracking  or  combat  maneuvers. 
The  third  configuration  (air-to-surface  gunnery  mode)  is  used  during  air  to  ground 
strafing  attacks.  The  fourth  configuration  is  the  air-to-surface  bombing  mode;  this 
mode  allows  the  pilot  precise  control  of  the  aircraft's  velocity  vector  for  accurate 
bombing.  This  thesis  investigates  the  design  of  parameter-adaptive  control  laws 
for  the  air-to-air  gunnery  mode  of  the  AFTI/F-16. 

2.3  Aircraft  Models 

The  state  and  output  equations  of  the  system  (plant)  to  be  controlled  are  in  the 
form 


i[t)  =  Ax(1)  +  Bu(t) 

(2 

-1) 

y{<)  =  Cx{<) 

(2 

-2) 

where 

A  =  continuous  plant  matrix  (n  x  n) 

B  =  continuous  input  control  matrix  (n  x  m) 

C  =  continuous  output  matrix  (l  x  n) 
x  =  state  variable  vector  with  n  states 
v  =  input  vector  with  m  inputs 
y  —  output  vector  with  /  outputs 

The  state  equations  are  obtained  from  the  aircraft  equations  of  motion,  which 
consist  of  equations  for  forces  and  moments  acting  upon  the  center  of  gravity. 
These  equations  are  perturbation  equations  about  a  nominal  condition.  A  detailed 


derivation  of  these  perturbation  equations  is  contained  in  Reference  15.  A  healthy 
aircraft  state  space  model  is  shown  in  Equation  (2-3).  The  primed  terms  in 
Equation  (2-3)  are  the  dimensionalized  derivatives  in  the  body  axis.  These  terms 
are  obtained  from  Reference  4  and  are  shown  in  Appendix  A.  This  equation  is 
also  used  for  a  failed  surface  state  space  model.  The  failed  model  is  generated  by 
decreasing  the  elements  of  the  first  column  in  the  B  matrix  by  50  percent. 

The  output  vector  for  this  model  is: 

y(f)  =  b,/?,r]r  (2-4) 


where 

-n  =  Flight-path  angle 
3  =  Sideslip  angle 
r  =  Yaw  rate 

Flight-path  angle,  sideslip  angle,  and  yaw  rate  are  chosen  as  the  outputs  so  that 
CB  has  full  rank  and  a  Proportional  plus  Integral  (PI)  controller  using  Porter’s 
technique  could  be  used.  The  need  for  these  requirements  is  explained  in  greater 
detail  in  Chapter  III. 
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Ill  Controller  Design 


3.1  Introduction 

This  chapter  presents  the  Proportional  plus  Integral  (PI)  controller  used  for 
this  thesis.  This  is  accomplished  by  first  reviewing  the  system  model  presented 
in  Chapter  II.  and  then  presenting  assumptions  made  in  the  selection  of  the 
controller.  The  procedure  used  to  calculate  the  controller  gain  matrices  (Kl  and 
K2).  if  the  system  matrices  (A,B,C)  are  known,  is  shown.  The  representation  of 
a  system  by  use  of  an  autoregressive  model  and  how  this  model,  in  conjunction 
with  the  step-response  matrix,  is  used  to  calculated  the  control  law  gain  matrices 
is  presented  next.  Finally,  this  chapter  concludes  with  a  brief  description  of  the 
adaptive  algorithm  which  is  used  for  the  design  of  an  adaptive  controller. 

3.2  System  Model 

As  discussed  in  Chapter  II.  the  state  and  output  equations  of  the  system 
(plant )  to  be  controlled  are  in  the  form 

x(l)  =  Ax{t)  +  Bu(t)  (2-1) 

y{t)  =  Cx(t)  (2-2) 

where 

A  —  continuous  plant  matrix  (n  x  n) 

B  =  continuous  input  control  matrix  (n  x  m) 

C  =  continuous  output  matrix  (/  x  n) 
j  =  state  variable  vector  with  n  states 


v  =  input  vector  with  m  inputs 
y  =  output  vector  with  /  outputs 

For  the  discrete-time  case,  the  above  model  can  be  written  in  the  following 
form  (6): 

x[{k  +  l)T]  =  9x(kT)  +  Tu(kT)  (3-1) 

y{kT)  =  Cx(kT)  (3  -  2) 

where 

$  =  exp(AT):  discrete  plant  matrix 
F  =  Jo  exp(Ar)Bdr  :  discrete  input  control  matrix 
T  =  sampling  period 
k  =  integer  from  zero  to  plus  infinity 

C  =  discrete  output  matrix 

3.3  Assumptions 

1.  Some  of  the  eigenvalues  of  A  may  lie  in  the  right-half  plane.  This  permits 
the  use  of  this  controller  on  plants  that  are  open-loop  unstable. 

2.  The  rank  of  the  first  Markov  parameter  (CB)  must  be  full  to  use  this 
controller.  If  the  rank  of  the  CB  is  not  full,  then  a  Proportional  plus  Integral  plus 
Derivative  (PID)  control  law  can  be  used  as  shown  in  Reference  19. 

3.  The  plant  model  is  completely  observable  and  controllable. 

4.  The  controllability  of  the  plant  due  to  integral  action  is  maintained.  This 
requires  that  the  matrix  R  have  rank  of  (n  -+  /)  (7).  where: 


e 


M?  c) 


This  controllability  can  also  be  verified  by  ensuring  the  rank  of  the  transfer 


function  G(s)  equals  l  . 


where 


G(s)  =  C\sl-  A}~'B 


(3-3) 


G(0)  =  -C[A)~'B 


(3-4) 


3.4  Controller  Gain  Calculation 


3.4.1  Matrix  Model.  For  fixed-parameter  plants,  tracking  of  an  input  vector 


(r)  via  Porter's  method  (8:9:14)  is  possible  for  small  values  of  sampling  periods 


(T)  using  the  digital  PI  controller  shown  in  Figure  3  —  1.  This  controller  is  an 


error-actuated  digital  controller  which  is  governed  by  the  PI  control  law  of  the  form 


shown  in  Equations  (3-5).  Integration  is  approximated  by  the  backward  difference 


equation  (Equation  (3-6)). 


u{kT)  =  (l/T)K  le(kT)  +  (l/T)K2<[kT) 


(3-5) 


?[(fr  +  1)^1  =  $(kT)  +  {l /T)e(kT) 


(3-6) 


A’AV.'.VA  '.V.V  .V.V  A 


>  .'n  >'*•  f 


Digital  Proportional  Plus  Integral  Controller 


where 

c(kT)  =  x(kT)-y(kT) 

t{kT)  =  digital  integral  of  e(kT) 

K 1  =  (CB)’1! 

A' 2  =  Kip 

T  =  sampling  period 

E  =  diagonal  weighing  matrix:  diag[<?l.  o2. . . .  ol  j 

p  =  ratio  of  integral  to  proportional  control 

The  diagonal  weighting  matrix  E  and  the  ratio  of  integral  to  proportional 
control  p  are  two  variables  which  the  designer  selects  to  obatain  the  desired 
response  from  the  system. 

If  the  system  matrices  are  not  known,  a  controller  for  the  above  system  can  also 
be  designed  using  the  step-response  matrix  (16).  The  step-response  matrix,  H(T). 
is  the  response  of  the  system  at  the  first  sample  period  (t  =  T)  due  to  a  step  being 
applied  at  time  equal  to  zero  (t  =  0).  The  step  response  matrix  can  be  obtained 
from  Equations  (2-1)  and  (2-2)  as  show  below. 

First,  solving  Equation  (2-1)  yields: 

x(0  =  e^xfO)  +  f  e*Tu(?  -  r)drB  (3  -  7) 

Jo 

Substituting  Equation  (3-7)  into  Equation  (2-2).  with  initial  conditions  equal 
to  zero; 

y(t)  =  C\f  eA'drB'  (3-8) 

.'0 
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Evaluating  Equation  (3-8)  for  a  step  input  yields; 


* 


* 


y(t)  =  CA-l(eAt-l*)B  (3-9) 

Which  is  the  definition  of  the  step-response  matrix  (H(t)): 

H{1)  =  CA~'(eAt  -  IS)B  (3-10) 

As  show  in  References  8.  9.  14.  <§j  16.  the  controller  gain  matrix  Kl  of  Equation 
(3-5)  becomes  A' 1  =  H(T)  ]E  .  Where  E  is  a  diagonal  tuning  matrix 

selected  by  the  designer.  For  small  values  of  sampling  periods  (T).  and  a  first 
order  approximation  of  eAt  ~  1\  ■+  AT  .  Equation  (3-10)  can  be  written  as: 


* 


H(T)  *  CA-'ds  +  AT  -  IS)B 


which  yields. 


«* 


e 


i 

i 

I 

\ 

c 


H(T)  TCB  (3-11) 

3.4.2  Autoregressive  Model.  One  form  of  expressing  the  input-output 
relationship  of  a  system  is  in  the  form  of  an  Nth  order  autoregressive  difference 
equation  (IT): 

y(kT)  +  Aly((k  -  1)7)  -s  A2y((k  -  2)7)  . . .  A.\y((k  -  \)T)  =  £lu((*  -  1)7) 

+  B2u{{k  -  2)7) . BXu{{k  -  \)T)  +  n(kT) 

(3-12) 

where 

Bi  =  /  x  m  matrices 
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C 


Ai  -  l  \  /  matrices 


<( kT )  =  zero  mean  Gaussian  white  noise  vector  with  variance  =  v2. 

The  order  of  the  model  (N)  depends  on  the  procedure  used  to  generate  the 
autoregressive  model.  The  original  algorithm  used  for  this  thesis  utilized  an 
autoregressive  model  derived  from  a  transfer  function  representation  (2).  This 
representation  can  be  derived  by  expressing  Equation  (3-2)  as  a  transfer  function 
that  relates  the  input  and  output  data  as  shown  in  Reference  20.  page  536.  This 
procedure  shown  in  Reference  23  is  briefly  reviewed  here. 

The  solution  to  Equation  (3-2).  with  initial  conditions  equal  to  zero,  is: 


VU)  =  C\zI  -*}~'Tu(z) 
which  can  be  written  in  the  form 


Y(z)  =  G(z)u(z) 


where 


G(z)  =  C\zl  -  4>]“  T 

\ 


/  G’jj(z)  G]2(z)  ...  G i m ( c )  \ 

G’2i(r)  G22(z)  ...  G2m(z) 


\  G/i(z)  .  Glm(z)  ) 
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(3-13) 


(3-14) 


(3-15) 


'c 


c 


/  «l(s)  \ 


V  Um(«)  / 

where  GtJ(z)  can  be  expressed  as: 

_  bltJzn  +  b2t]zn  ~ 1  +  . . .  +  6(A  -  l)tJr  +  b.\ 
~  zs  +  o  1  z* ~ 1  +a22-v-*...  +  a(.V  -  l)*  +  a.V 


(3-16) 


where  A*  >  IV  -+•  1  for  a  proper  system. 

Now  divide  the  numerator  and  denominator  of  Equation  (3-16)  by  Z~A 
.which  yields: 


bl,jZ  1  +  b2tJz  2  +  . ..+  bXz 
1  ■+■  alz~l  +  a2z  2  .  .  .  -t-  a.\  z 


(3-17) 


Substituting  Equation  (3-17)  into  t/,(c)  =  G.ji/jfr)  and  rearranging  yields: 


y,  +  alz  1  y,  -*■  c2z  2y,...  +  a.Xz  A  y,  =  blt)z ' 1  v}  +  b2tJz~  2Uj  +  . . .  +  bNtJz~sUj 

It  is  important  to  note  that  the  "a"  coefficients  of  Equation  (3-17)  do  not 
have  subscript*-.  Subscripts  are  not  required  because  the  denominator  of  Equation 
(3  -  16)  is  the  characteristic  equation;  therefore  the  "a"  coefficients  at  each  delay 
period  are  the  same  for  all  the  individual  transfer  functions.  That  is.  al  of  Gu  = 
ol  of  G23-  and  c2  of  GV,  =  a 2  of  G34.  and  so  forth 

Finally,  taking  the  inverse  Z  transform  (20:1 16).  yields  Equation  (3-12): 


23 


e 


y(kT)  +  Aly((k  -  1)T)  +  A2y((k  -  2)7)  . .  .  A\y((k  -  .V)7)  =  Blu{{k  -  1)7) 

+  B2u[[k  -  2)7) . BJVu((*  -  A*)7)  +  n(kT) 

(3-12) 

The  order  “N"  of  Equation  (3-12)  is  equal  to  the  order  of  the  denominator 
(number  of  states)  of  Equation  (3-16). 

Equ  ation  (3-12)  can  also  be  written  as: 

y(kT)  =  *( kt)Q(kT )  +  V(kT)  (3  -  18) 

where  , p(kT )  is  a  matrix  which  contains  the  values  of  past  input  and  output 
data.  Q(kT )  is  the  parameter  vector  which  contains  the  coefficients  of  the 
autoregressive  equations,  and  r/(kT)  is  assumed  to  be  a  zero-mean  Gaussian 
white-noise  vector  with  variance  a2  .  For  example,  given  a  system  which  has  2 
outputs.  3  inputs  and  a  2nd  order  autoregressive  equation,  then  for  the  first  delay 
(N  =  l)  of  Equation  (3-18): 

r(kT)  would  be  written  as: 

/v,(k-  1)  u2(*-D  «3(*-l)  0  0  0  yj(k-l)\ 

'  0  0  0  «,(*-!)  v2(k-l)  v3(k  -  1)  y2{k-l)J 


Q(kT)  = 


13 
bl2i 

bl22 
bl22 
\  ol  ; 

Another  way  of  obtaining  the  Ai  and  Bi  matrices  of  Equation  (3-12)  is  by  open- 
loop  testing  via  the  step-response  matrix  method  shown  in  chapter  8  of  Reference 
19.  This  method  requires  that  either  the  AFTI/F-16  be  available  for  open-loop 
testing  or  the  order  of  the  autoregressive  model  be  known  so  that  a  computer 
simulation  of  the  open-loop  response  could  be  accomplished.  A  procedure  for 
determining  the  order  of  the  autoregressive  model  is  showm  in  Reference  22. 

The  procedure  given  in  Reference  22  can  also  be  used  to  determine  the  Ai  and 
Bi  matrices  of  equation  (3-12).  Therefore,  the  step-response  method  shown  in 
Reference  19  was  not  used  for  this  thesis;  instead  the  technique  explained  in 
Reference  22  was  utilized.  Reference  22  procedures  are  outlined  in  Appendix  B. 
When  this  method  is  used  then  the  order  of  the  autoregressive  model  does  not 
necessary  equal  the  number  of  states  in  the  state-space  model.  The  order  will 
usually  be  less  than  the  number  of  states  in  the  system.  In  fact  for  the  model 
shown  in  Equation  (2-3),  the  order  of  the  autoregressive  model  is  four:  whereas, 
the  number  of  states  is  equal  to  eight.  However,  unlike  the  autoregressive  equation 
derived  from  the  transfer  function,  the  Ai  matrices  are  now  fully  populated.  This 


can  be  seen  in  Appendix  B. 

Once  the  autoregressive  coefficients  are  determined  then  the  controller  gains 
Kl  and  K2  are  given  in  Reference  17  as  follows  (17): 

Kl  =  Ht(T)[H(T)Ht(T)\-1'L  (3-19) 

K2  =  C?T(0)[G(0)G7'(0)]~1n  (3-20) 

where 

H(T)  =  Bl 

£  =  weighing  matrix:  diag[erl,  <t2,  ...ol  ] 

IT  =  weighing  matrix;  diagjtfl,  7r2. . .  ,tI\ 

and 


G(0)  =  (/  +  A1  +  A2  +  A3+  ....AN)~l(Bl  +  B2  +  B3....BN)  (3-21) 

By  applying  the  definition  of  the  step-response  matrix,  given  in  Section  3.4.1, 
to  Equation  (3-12)  it  can  be  seen  that  Bl  is  the  step  response-matrix.  This  is  due 
to  the  fact  that  all  the  elements  of  Equation  (3-12)  are  equal  to  zero  at  time  equal 
to  ”T”  except  Bl;  therefore,  Bl  is  by  definition  the  step-response  matrix. 

The  autoregressive  coefficients  used  to  determine  Kl  and  K2  can  be  estimated 
using  a  recursive  least  square  estimation  algorithm  such  as  the  one  mentioned  in 


the  next  section. 


3.5  Parameter-Adaptive  Algorithm 

The  main  objective  of  least  square  estimation  is  to  minimize  (21:120) 

“...the  sum  of  squares  of  the  differences  between  the  actual  measurement  data 
and  the  proposed,  or  estimated,  function  or  curve." 

For  this  thesis  the  function  estimated  is  the  parameter  vector  Q(kt).  As 
explained  in  Section  3.42.  this  parameter  vector  is  composed  of  the  coefficients  of 
the  autoregressive  model  described  earlier  in  this  chapter.  The  ability  to  estimate 
these  coefficients  can  then  allow  updating  of  the  controller  gains  Kl  and  K2  via 
Equation  (3-19)  and  Equation  (3-20).  This  research  uses  a  modified  recursive  least 
square  estimation  algorithm  developed  by  Hagglund  (13).  The  algorithm  has  been 
expanded  from  the  single-input  single-output  case  developed  by  Hagglund  to  the 
multiple-  input  multiple-output  case  required  for  this  thesis.  This  expansion  was 
accomplished  by  Pinerio  (2).  A  detailed  description  of  the  algorithm  is  contained 
in  Reference  13  and  Reference  2,  section  3.4.  The  equations  implemented  in  the 
algorithm  are  contained  in  Appendix  C. 

3.6  Summary 

The  Proportional  plus  Integral  (PI)  controller  used  for  this  thesis  and  the 
procedure  used  for  calculating  the  control  law  gain  matrices.  Kl  and  K2  are 
presented  in  this  chapter.  The  system  model,  assumptions,  and  the  procedure  used 
to  calculate  Kl  and  K2  if  the  system  matrices  (A.B.C)  are  known  are  show-n.  How 
to  calculate  the  controller  gains  via  an  autoregressive  model  in  conjunction  w’ith 
the  step-response  matrix  is  also  reviewed.  Finally,  this  chapter  concludes  with 
a  brief  description  of  the  adaptive  algorithm  used  for  the  design  of  an  adaptive 


controller. 


IV  Simulation  and  Results 

4 . 1  Introduction 

This  chapter  presents  the  sequence  of  steps  taking  in  the  simulation  and  testing 
of  the  fixed,  and  adaptive,  gain  digital  PI  controller.  Also,  the  results  of  this 
simulation  are  given.  The  simulation  sequence  consists  of  first  verifying  that  the 
model  chosen  does  not  violate  the  assumptions  made.  Then  an  autoregressive 
model  is  generated  to  permit  implementation  of  the  PI  control  laws.  Using  an 
autoregressive  model,  a  fixed  gain  controller  is  designed  for  a  healthy  aircraft. 
Aircraft  response  for  both  a  healthy  and  failed  model  are  then  obtained  for  the 
fixed  gain  controller.  Finally,  adaptive  simulations  are  performed  for  both  a 
healthy  and  a  failed  model. 

The  computer-aided  design  program  called  MATRIX*  is  used  for  this 
simulation  (19).  MATRIX*  allows  the  user  the  option  of  executing  a  series  of 
operation*-  by  the  use  of  macros.  These  marcros  are  user  defined  text  strings  which 
can  be  save  and  executed  with  a  single  command.  Throughout  this  simulation 
several  macros  are  used;  these  macros  are  listed  in  Appendix  D. 

4.2  Assumption  Verification 

The  macros  shown  in  Appendix  D.  page  D-l  through  D-3  are  used  to  verify 
that  the  assumptions  made  in  Chapter  III.  section  3-3.  are  not  violated.  The 
nominal  plant  matrices  are  shown  in  Table  4-1.  As  can  be  seen  in  Append.x  D. 
the  nominal  plant  did  not  violate  the  assumptions.  Once  these  assumptions  are 
verified  then  the  autoregressive  model  is  generated. 


Table  4-1  Nominal  Plant  Matrices 


Plant  Matrix  (A) 


O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

l.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

-3.21S3D+01  - 

5.6009D-02 

3.8291D+01 

-3.013SD+01 

O.OOOOD+OO 

O.OOOOD+OO 

-1.1000D-03 

4.5971D— 05 

■1.4845D+00 

9.9480D— 01 

O.OOOOD+OO 

O.OOOOD+OO 

3.0000D  -04  - 

2.1010D-03 

4.2717D+00 

-7.7720D— 01 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

3.4500D-02 

-3.4536D— 01 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD  +  OO 

-5.5253D+01 

0.0000D+00 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

7.2370D+00 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD  +  OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD  +  OO 

O.OOOOD  +  OO 

1.0000D  +  00 

O.OOOOD  +  OO 

3. 2600 D  -02 

-9.9760D-01 

-2.S004D  +  00 

1.4570D-01 

-2.3200D-02 

-3.6250D-01 

Input  Control  Matrix  ( B ) 


O.OOOOD  —  OO 

O.OOOOD+OO 

O.OOOOD  +  OO 

O.OOOOD—OO 

O.OOOOD-rOO 

1.0030D+00 

1.0030D-rOO 

1.1584D+00 

1.15S4D+00 

1.9254D+01 

-7.4600D-02 

-7.4600D-02 

-1.2250D-01 

-1.2250D-01 

O.OOOOD-rOO 

-1.2029D+01 

-1.2029D+01 

-3.2363D+00 

-3.2363D— 00 

O.OOOOD-rOO 

O.OOOOD+OO 

O.OOOOD+CC 

O.OOOOD  +  OO 

O.OOOOD+OO 

O.OOOOD  +  OO 

-3.3000D-03 

3.3000D-03 

7.0000D  -04 

-7.0000D  — 04 

O.OOOOD-rOO 

6.3395D-rOO 

-0.3395D  +  00 

2.5519D+01 

-2.5519D— 01 

O.OOOOD—OO 

6.4200D  -01 

-G.4200D-01 

6.2490D-01 

-6.2490D-01 

O.OOOOD+OO 

29 


4.3  A u  t oregressive  Model  Generation 

The  procedure  to  generate  an  autoregressive  model  from  a  state-space  model 
is  show  in  Appendix  B.  The  Macros  contained  in  pages  C-5  through  C-6  are  used 
to  implement  this  procedure.  Two  verifications  are  done  to  obtain  confidence  in 
the  values  generated  from  this  procedure  and  macros.  First,  the  value  obtained 
for  the  matrix  Bl  is  compared  to  the  value  obtained  for  the  step  response  matrix 
given  by  Equation  (3-11).  This  comparison  is  shown  in  Table  4-2.  The  difference 
between  the  two  methods  is  in  the  fifth  decimal  place.  Next,  the  value  obtained 
for  G(0)  from  the  autoregressive  model  (Equation  (3-21))  is  compared  to  the  value 
of  G(0)  obtained  from  Equation  (3-4).  This  comparison  is  shown  in  Table  4- 
3.  Subtracting  the  two  calculations  of  G(0).  reveals  that  the  difference  is  in  the 
seventh  decimal  place. 

4.4  Fixed  Gain  Controller 

4.4.1  Healthy  Mode].  The  nominal  plant  in  series  with  the  controller  is 
simulated  in  MATRIX*,  using  its  svstem-build  capability.  The  block  diagram 
and  interconnection  of  this  simulation  is  contained  in  Appendix  E.  This  simulation 
produces  unstable  responses.  This  instability  is  due  to  a  transmission  zero  in  the 
right-half  plane.  References  7.  25,  and  26  show  that  the  transmission  zeros  of  a 
plant,  where  the  number  of  inputs  equal  the  number  of  outputs  (square  plant),  can 
be  obtained  by  setting  the  determinant  of  the  system  matrix  S  equal  to  zero. 


Table  4-2  Comparison  of  Bl  and  Step-Response  Matrix 
Bl  of  Autoregressive  Model 

7.3442D— 04  7.3442D-04  1.2143D-03  1.2143D-03  -4.4090D-0S 

-5.4597D— 05  5.4597D— 05  1.7295D  — 05  -1.7295D— 05  0.0000D+00 
6.3994D-03  -6.3994D-03  6.2089D-03  -6.2089D-03  O.OOOOD+OO 

Step-Response  Matrix  (H  ^  TCB) 

7.4600D  — 04  7.4600D  -04  1.2250D-03  1.2250D-03  O.OOOOD+OO 

-3.3000D— 05  3.3000D-05  7.0000D-06  -7.0000D-06  0.0000D+00 

6.4200D— 03  -6.4200D-03  6.2490D-03  -6.2490D-03  O.OOOOD+OO 

Difference  Between  Bl  and  Step-Response  Matrix 
1.15S1D— 05  1.15S1D-05  1.06S4D-05  1.0684D-05  4.4090D-08 

2.1597D— 05  -2.1597D— 05  -1.0295D-05  1.0295D-05  O.OOOOD+OO 

2.0G14D  — 05  -2.0614D— 05  4.0103D-05  -4.0103D-05  O.OOOOD  +  OO 


Table  4-3  Comparison  of  G(0) 


G (0 )  from  Autoregressive  Model 


1.0834D+01 

1.0834D-01 

3.1894D->-00 

3.1894D+00 

5.9969D-01 

1.2604D-01 

-1.2604D-01 

4.9232D-01 

-4.9232D-01 

O.OOOOD+OO 

4.2S74D-00 

-4.2874D-00 

1.1553D+01 

-1.1553D-(-01 

0.0000D+00 

G(0)  using  -CA  ]B 

1.0S34D+01 

1.0S34D+01 

3.1894D+O0 

3.1894D  +  00 

5.9969D— 01 

1.2604D-01 

-1.2604D-01 

4.9232D-01 

-4.9232D-01 

O.OOOOD+OO 

4.2S74D-00 

-4.2874D-00 

1.1553D+01 

-1.1553D+01 

0.0000D+00 

where 


_  /  si  -  A  B  \ 

~  {  ~C  0  ) 


(4-1) 


Since  the  nominal  plant  for  this  research  is  a  rectangular  plant.  Equation  (4-1) 


cannot  be  used  to  determine  the  location  of  the  transmission  zeros.  As  suggested 


by  Professor  Porter,  the  controller  is  placed  in  series  with  the  rectangular  plant 


to  form  a  square  system  (Ss).  Figure  4-1  depicts  this  new  square  system.  When 


Equation  4-1  is  applied  to  the  Ss  and  the  determinant  of  Ss  is  set  equal  to  zero. 


then  eight  roots  are  identified.  Their  locations  are: 


-1.G216D  *02 


-1.0096D+01 


9.6680D -J-OO 


-1.0522D— 00 
-3.5175D  — 01 


-5.5501D  — 03 


-5.1412D  — 02 


-5.5550D  — 02 


As  explained  in  Reference  6  and  7.  the  number  of  roots  («*•)  of  Equation  (4-1). 


for  a  square  plant,  are  calculated  as: 


=  X  -I 


(4-2) 


where 


.V  =  number  of  states 


/  =  number  of  outputs 


Since  Ss  contains  11  states  and  3  outputs.  Equation  4-2  appears  to  be  valid 


V. 


FIG.  4-1  Square  System  (Ss) 


for  this  system.  The  above  transmission  zeros  are  calculated  with  the  weighing 
matrices  Pi(Il  )  and  Sigma  (E)  equal  to  diag[0.9.  0.9.  0.9]  and  diag[0.003.  0.003. 
0.095],  respectively. 

As  shown  in  References  6  and  7.  the  slow  mode  roots  (Zl)  of  a  square  plant  for 
this  type  of  PI  controller  are  calculated  as: 

Zl  =  (|AA'1  +  A'2|  =  0)  (4-3) 

However  when  the  determinant  of  Ss  is  set  to  zero,  then  both  the  slow  mode 
roots  and  the  transmission  zeros  appear  as  roots.  Therefore,  to  determine  if  the 
root  at  9.668  is  a  transmission  zero  or  a  slow  mode  root  the  sign  of  Kl  is  changed 
from  plus  (  +  )  to  minus  (-).  Since  A'2  —  Gr  (0) [G(0)G:r  (0)] ~ 1  FI  (Equation 
(3-20) ).  the  sign  change  of  Kl  is  accomplished  by  multplving  II  by-1.  The  new 
location  of  the  roots  are  now: 

-1.6216D  +  02 
9.6435D-f-00 
-1 .01 17D+01 
-1.0522D  +  00 
3.5175D— 01 
5.5501D— 03 
5.1070D— 02 
-5.5942D— 02 

As  can  be  seen,  the  root  at  9.668  moves  to  9.6435:  however  this  root  does  not 
change  sign  and  is  still  in  the  right-half  plane.  The  root  at  0.3517,  0.0055.  and 
0.05071  changed  sign:  these  are  the  slow  mode  roots.  Hence,  the  root  at  9.6  is  a 
transmission  zero. 

The  value  of  fl  is  kept  constant  at  diag[  0.9:0. 9:0. 9]  while  E  is  varied  to  observe 


the  impact  it  has  on  the  location  of  the  right-half  transmission  zero.  Sigma  is 


varied  from  diag[0.9.0.9.0.9]  to  diag'0.0,0].  The  resulting  transmission  zero  in  the 
right-half  plane  goes  from  9.65  to  13.45.  As  mentioned  in  chapter  II.  the  AFTI/F- 
16  is  longitudinally  unstable  (pole  in  the  right-half  plane).  With  a  pole  and  a 
transmission  zero  both  in  the  right-half  plane,  it  is  not  possible  to  get  a  stable 
response  using  this  type  of  PI  controller. 

Since  the  above  system  could  not  be  stabilized,  a  different  output  vector  is 
chosen.  The  second  output  vector  consists  of  forward  velocity,  sideslip  angle,  and 
yaw  rate.  The  output  matrix  is  now: 


C  = 


/0  1  0  0  0  0  0  O' 

0  0  0  0  0  1  0  0 

k0  0  0  0  0  0  0  1  , 


The  same  procedure  of  adding  the  controller  in  series  with  the  plant  is 
accomplished  for  this  second  plant.  With  H  equal  to  diag[0.003.  0.003.  0.0951  and 
FI  equal  to  diag  0.9.  0.9.  0.9]  the  transmission  zeros  for  this  plant  are  located  at: 

-1  6216D-r02  -f  O.OOOOD+OOi 
-7.8847D-I-00  -I- O.OOOOD  +  OOi 

-2.4463D-01  +1.0992D-t-00i 

-2.4463D-01  — 1.0992D+O0i 

-1.0522D+00  +0.0000D+00i 

-3.5175D— 01  +O.OOOOD+OOi 
-5.5501D— 03  +0.0000D+00i 

2.9025D— 02  +0.0000D+00i 

When  the  same  procedure  of  setting  all  the  elements  of  II  to  -0.9  is 
accomplished,  it  is  observed  that  the  zero  at  0.0029  is  a  slow  mode  root.  This 
root  is  placed  in  the  right-half  plane  by  making  the  first  element  of  II  a  negative 
number.  For  II  =  diag[  -0.9.  0.9.  0.9]  the  transmission  zeros  are  now  located  at: 
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C 


-1.6216D-02  -t-O.OOOOD  +  OOi 
-7.8454D^OO  +0.0000D->-00i 

-2.3610D-01  +1.1139D  +  00i 

-2.3610D-01  -1.1139D+00i 

-1.0522D+00  +0.0000D+00i 

-3.5175D-01  +O.OOOOD+ OOi 
-S.5501D-03  40.0000D+00i 

-2.S527D  -02  +O.OOOOD+OO1 

This  plant  is  now  stable.  Table  4-4  contains  the  values  which  are  used  to 
obtain  a  stable  response  for  this  plant . 

The  above  system  is  now  simulated  in  the  system-build  portion  of  MATRIX  jy. 
The  maneuver  choosen  for  evaluating  the  system  is  a  coordinated  turn.  This 
maneuver  is  accomplished  by  commanding  beta  to  zero  and  commanding  a  yaw 
rate.  The  command  shown  in  Figure  4-2  is  applied  to  the  yaw  rate  input.  This 
command  produces  a  bank-angle  \o)  via  the  the  relationship  between  yaw  rate  and 
o  given  in  Blakt  lock  (  :  1 4 7 )  as: 

r  =  y.sino  (4-3 

where 

V  =  forward  velocity  of  the  aircraft 

g  =  gravitational  constant  (32.2  ft/sec) 

Responses  due  to  this  input  are  shown  in  Figure  4-3  through  Figure  4-G. 

Once  a  stable  controller  is  designed,  then  the  actuator  dynamics  are  added  to  the 
simulation  prior  to  attempting  to  fine  tune  the  controller.  All  attempts  to  tune  the 
controller  with  actuator  dynamics  added  have  been  unsuccessful.  At  this  time,  no 


Table  4-4  Closed-Loop  Response  -  Without  Actuators 
E  =  diagj0.03,  0.003,  0.095], 
n  =  diag[-0.9.  0.9.  0.9]. 

Closed-Loop  Poles 

-2.8849D-03  +0.0000D+()0i 
-5.5229D-03  +O.OOOOD+OOi 
-2.4983D-01  -f-O.OOOOD+OOi 
-9.9236D-01  -f0.0000D  +  00i 

-1.8210D-01  +  1.2683D  +  00i 

-1.8210D-01  -1.2683D+00i 

-2.4316D+00  +3.4542D+00i 
-2.4316D+00  -3.4542D+ OOi 

-5.6535D-01  -f-5.9474D->-00i 

-5.6535D-01  -3.9474D-sOO) 

-1.0850D+01  +  0.0000D^00i 


DFGRF 


further  attempts  are  made  to  tune  the  fixed  gain  controller  with  actuator  dynamics 
and  the  research  into  the  fixed  gain  failure  model  and  the  adaptive  controller 
is  continued.  Therefore,  fixed  gain  failure  and  adaptive  controller  simulations 
do  not  include  actuator  dynamics.  However  later  in  the  research,  actuators  are 
implemented  as  shown  in  Appendix  E.  pages  E-35  through  E-38.  The  response 
of  the  fixed  gain  controller  with  the  actuators  is  now  stable.  The  responses  of  the 
aircraft,  with  actuators,  due  to  the  input  shown  in  Fiqure  4-2  are  contained  in 
Figure  4-7  through  4-10. 

4.4.2  Fixed  Gain  Failure  Model.  After  the  controller  gains  for  the  healthy 
model  (without  actuator  dynamics)  are  obtained,  then  a  simulation  is  run  with  the 
same  controller  gains  but  with  the  aircraft  failure  model  in  the  simulation.  The 
aircraft  failure  model  consist  of  reducing  the  left  elevator  effectiveness  by  50T . 

The  same  maneuver  commanded  for  the  healthy  model  is  used  for  this  simulation. 
Aircraft  response  data  are  obtained  and  the  results  are  presented  in  Figure  4-11 
through  Figure  4-14.  As  can  be  seen  from  these  plots  the  aircraft  goes  unstable  due 
to  this  failure.  The  next  step  taken  is  to  design  an  adaptive  controller  and  obtain 
data  to  allow  comparison  with  the  fixed  gain  controller. 

4.5  Adapt  iv  eC  on  t  ro  Her 

Adaptive  simulations  are  conducted  after  obtaining  data  for  the  fixed  gain 
controller.  First,  simulations  with  the  healthy  model  are  accomplished.  These 
simulations  are  conducted  by  first  initializing  the  parameter  vector  with  the  correct 
values  for  the  given  plant .  The  first  two  seconds  of  the  simulation  are  conducted  in 
the  fixed  gain  mode,  then  the  adaptive  controller  is  turned  on. 


FIG  4-12  FIXED  GAIN  PITCH  ANGLE  RESPONSE  -  WITH  FAILURE 


-I - *. - — ,1  ,  *  ,  ,  ,.J - - - . - I _ . - . _ I — 

3  6  9  12  15 


TIME  (SEC) 

FIG.  4-13  FIXED  GAIN  SIDESLIP  ANGLE  RESPONSE  -  WITH  FAILURE 


The  purpose  of  the  adaptive  controller  is  to  identify  (estimate)  the  first  15 
elements  (Bl  matrix)  of  the  parameter  vector.  The  remaining  76  elements  of 
the  parameter  vector  are  held  constant  during  the  simulation.  The  responses  of 
the  aircraft  are  displayed  in  Figure  4-15  through  4-18.  Inspection  of  these  plots 
reveals  that  the  controller  appears  to  be  stable.  However,  inspection  of  the  Bl 
matrix  elements,  shown  in  Fiqure  4-19  and  Figure  4-24.  reveal  that  the  elements 
of  Bl  are  very  erratic  after  15  seconds.  In  order  to  determine  the  effect  this  erratic 
estimate  would  have  on  the  aircrat  response  if  a  maneuver  is  commanded  during 
this  time  frame,  the  three  pulse  yaw  rate  command  show  in  Figure  4-25  is  applied 
as  an  input.  Figures  4-26  through  4-29  contain  the  aircraft  responses  due  to  this 
three  pulse  command.  As  can  be  seen,  the  aircraft  goes  unstable.  The  estimates 
of  Bl  are  show  in  Figure  4-30  through  Figure  4-35.  All  the  elements  of  Bl  have 
a  large  burst  at  approximately  18  seconds.  These  bursts  can  be  caused  by  lack 
of  excitation  in  the  input  signal.  As  stated  in  Chapter  1.  a  lack  of  "persistently 
exciting"  inputs  can  cause  poor  parameter  estimates  (12:598).  Therefore  to 
determine  if  the  adaptive  controller  requires  additional  input  excitation,  the 
noise  input  shown  in  Figure  4-37  is  applied  as  the  yaw  rate  command.  Aircraft 
responses  due  to  this  command  are  contained  in  Figure  4-36  throught  Figure  4-40. 
These  plots  show  that  the  aircraft  is  stable  and  the  yaw  rate  channel  is  attempting 
to  track  the  input  command.  The  estimates  of  Bl  shown  in  Figure  4-41  through 
4-46  do  not  have  the  large  burst  observed  when  the  three  pulse  input  is  applied. 

The  next  step  taken  is  to  fail  the  left  elevator  by  50  c7  and  observe  if  the  adaptive 
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controller  identifies  the  new  plant  Bl  matrix.  The  Bl(l.l).  Bl  (2.1 1.  and  Bl(3.1) 
elements  of  the  failed  model  are  one  half  the  value  of  the  healthy  model.  The 
remaining  elements  of  Bl  are  the  same  for  both  plants. 

The  failure  i?  introduced  six  second'  into  the  simulation.  The  response  of 
the  aircraft  due  to  this  failure  (with  t lie  noise  input)  for  the  fixed  gain  controller 
i?  required  so  as  to  allow  comparison  of  t he  fixed  and  adaptive  controller 
performance. 

The  result?  of  this  simulation  for  the  fixed  gain  are  shown  in  Figure  4-47 
through  Fiqure  4-50.  The  results  of  this  simulation  for  the  adaptive  gain  controller 
art  shown  in  Figure  4-51  through  Figure  4-55.  Comparing  the  yaw  rate  and  bank 
angle  of  both  controllers  reveals  that  the  fixed  gain  controller  is  going  unstable 
toward  the  end  of  the  simulation:  whereas,  the  adaptive  controller  responses 
art  becoming  more  stabk  .  The  reason  the  adaptive  controller  is  more  stable 
than  the  fixed  gain  controller  is  because  the  estimates  of  Bl  ( 1.1 )  and  B 1  ( 3 . 1 )  are 
becoming  smaller,  as  required.  However,  the  estimated  negat  ive  value  of  Bl  (2.1 )  is 
increasing  when  it  should  have  been  decreasing.  The  value  of  Bl  ( 2.1 )  is  very  small 
when  compared  to  the  value  of  Bl(l.l)  L  B(3.1)  and  the  response  of  the  system 
may  be  dominated  by  the  effect'  of  Bl(l.l)  and  B  1(3.1). 

To  determine  if  the  adaptive  controller  is  attempting  to  converge  on  the  correct 
plant  parameters  requires  addtional  testing.  Also,  tuning  and/or  modification  to 
the  adaptive  controller  is  required  to  decrease  the  convergence  time.  All  of  these 
options  required  more  time  then  is  presently  allocated  to  this  research:  therefore. 
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further  testing  was  abandoned  and  conclusions  and  recommendation  are  made 
from  the  results  obtained  up  to  this  point. 


Chapter  V  Conclusions  and  Recommendations 

5.1  Conclusions 

5.1.1  Fixed  Gain  Controller.  In  order  to  design  a  Multiple- Input  Multiple- 
Output  (MIMO)  fixed  gain  controller  for  a  rectangular  plant,  using  Porter’s 
technique,  requires  knownledge  of  the  location  of  the  transmission  zeros. 
Specifically,  all  the  transmission  zeros  must  lie  in  the  left-hand  plane  for  this 
unstable  plant.  Location  of  the  transmission  zeros  can  not  be  determined  using 
the  procedure  previously  used  for  a  square  plant.  However,  if  the  controller  is 
placed  in  series  with  the  plant  and  a  new  “square  system  ”  is  formed,  then  the 
procedure  used  for  the  square  plant  yields  the  location  of  the  transmission  zeros  of 
the  “square  system”. 

5.1.2  Adaptive  Controller.  The  MIMO  adaptive  gain  controller  required  that 
noise  be  inserted  as  the  input  signal  to  aid  the  controller  in  identifying  the  plant 
parameters.  When  a  failure  was  introduced,  the  adaptive  controller  was  more 
stable  than  the  fixed  controller.  However,  it  was  not  determined  if  the  additional 
stability  of  the  adaptive  controller  was  caused  by  an  attempt  of  the  controller 

to  identify  the  plant  parameters,  or  because  the  controller  was  diverging  in  the 
direction  of  the  new  plant  parameters.  If  the  additonal  stability  was  due  to  the 
diversion,  then  this  controller  would  also  become  unstable. 

5.2  Recommendations 

Recommend  that  further  research  be  conducted  to  determine  a  precise 
technique  for  calculating  the  transmission  zero  locations  for  a  rectangular  plant. 


Recommend  that  testing  and  tuning  of  the  rectangular  plant  with  actuator 
position  and  rate  limits  be  accomplished. 

Recommend  that  additional  tuning  and  or  modification  be  performed  on  the 
adaptive  algorithm  to  decrease  the  convergence  time  required  in  identifying  the 
plant  parameters. 

Upon  successful  completion  of  the  above  recommendations,  recommend 
that  the  effect  of  different  failure  models,  noise,  delays,  and  sensor  dynamics,  be 
evaluated  on  both  a  fixed  gain  and  adaptive  controller. 


Appendix  A:  Aircraft  Data 


Introduction 

This  appendix  contains  the  aircraft  data  that  is  used  for  the  models  of  this 
thesis.  Table  A-l  contains  common  aircraft  data,  while  Table  A-2  contains  the 
primed  stability  derivatives  for  the  flight  conditions  specified  in  this  thesis.  This 
data  was  obtained  and  reprinted  from  Reference  4. 

Table  A-l 
Aircraft  Data 

S  wing  reference  area  =  300.0  ft2 

C  wing  mean  aerodynamic  cord  =  11.32  ft 

B  wing  span  =  30.0  ft 

W  weight  =  21.018.0  lbs 

M  mass  =  652.73  slugs 

lj  x-axis  moment  of  inertia  =  10.033.4  ft2 

Iu  y-axis  moment  of  inertia  =  53.876.3  ft2 

lz  z-axis  moment  of  inertia  =  61.278.4  ft2 

Ij;  product  of  inertia  =  282.132  ft2 

Q  dynamic  pressure  =  552.11295  lbs /ft 2 

\'t  trim  velocity  =  933.23  ft/s ec 

a t  trim  angle  of  attack  =  0.03246  radians 


c 


Table  A-2 


Primed  Dimensional  Derivatives  in  the  Body  Axis 


Xg  =  -32.1830 

Z’e  =  -0.001120 

Mg  =  0.000309 

X'u  =  -0.056009 

zi  =  0.000045971 

Mi  =  -0.002101 

• 

X'a  =  38.2906 

Z'Q  =  -1.48446 

ML  =  4.27171 

X'q  =  -30.1376 

Z'q  =  0.994789 

Ml,  =  -0.777221 

X'6tt  =  2.005930 

Z'6tt  =  -0.149227 

M;et  =  -24.0581 

• 

X'6ft  =  2.31681 

Z'tJ  =  -0.244924 

M'6Ji  =  -6.47269 

AT  ~  19  254 

M'6c  =  -0.9864 

V'  —  0  034486 

l'J  =  0.343554 

V3  =  -55.2526 

N'0  =  7.2370 

c 

Yl  =  0.032636 

=  -2.80004 

AT  =  -0.023184 

Yt  —  0.997556 

L't  =  0.145674 

AT  =  -0.362530 

YlDF  =  -0.001371 

=  -51.0502 

A';Dr  =  -1.25006 

• 

YfiDT  =  0.026609 

=  -50.7290 

ATDr  =  -5.13710 

V/r  =  0.037032 

L'br  -  10.3955 

A*;r  =  -5.80890 

Yfi'r  =  0.026734 

L'bc  =  5.53185 

A’jf  =  5.89254 

Appendix  B:  Calculation  of  Autoregressive  Model  From  State-Space  Model 

B.l  Introduction 

This  appendix  consist  of  three  parts.  The  first  part  presents  the  procedures 
used  in  deriving  the  autoregressive  model  from  a  state-space  model.  The  second 
part  presents  the  MATRIX*  macros  used  to  implement  this  procedure  and 
calculate  the  autoregressive  model  coefficients.  The  last  part  depicts  the  use  of  the 
macros  to  generate  the  three  autoregressive  models  required  for  this  thesis. 

B.2  Autoregressive  Model 

The  procedure  to  generate  an  autoregressive  model  from  a  state-space  model 
is  extracted  from  reference  22  and  is  condensed  in  this  appendix  .  Detailed 
definitions,  propositions,  proofs  and  theorems  are  contained  in  reference  22. 

Given  a  state-space  representation  of  the  form  shown  in  chapter  III.  equations 
2-1  and  2-2.  it  is  possible  to  generate  an  autoregrresive  model  of  the  form: 


A0y(k)  +  Axy(k  -  1)  +  . . .+  Aqy{k  -  q)  =  Bjv(k  -  1)  +  B 2v(h  -  2)  +  ...  +  Bru(k  -  r) 

(B-l) 

To  determine  the  ,4,  and  B ,  coefficients  the  following  procedure  must  be 
accomplished. 

1.  Ensure  that  the  inverse  of  A  exists  and  that  C  is  of  full  rank.  Then  form  a 


constructibility  matrix  Co  as: 


Co  = 


CA~ 1 
CA~2 


(B-2) 


2.  Check  to  make  sure  that  Co  has  a  rank  equal  to  the  number  of  states  in  the 


state-space  representation. 


3.  Form  a  temporary  transformation  matrix  (TT)  from  the  linearly 


independent  row  vectors  of  Co.  This  is  accomplished  by  taking  the  first  row  of 


Co  [C-^A  1 )  and  making  it  the  first  row  of  TT.  Next,  examine  the  second  row  of 


Co  (C2A  1 ).  If  it  is  linearly  independent  of  the  row  vector  in  TT.  then  make  it 


(C2A  1 )  the  second  row  of  TT.  Continue  the  process  with  the  next  row  of  Co.  If  it 


is  linearly  independent  of  the  row  vectors  in  TT  then  incorporate  it  into  TT.  Once 


the  last  row  of  Co  (CiA  A)  has  been  examine  and  TT  formed,  then  the  next  step 


is  to  rearrange  the  rows  of  TT  and  form  a  new  transformation  matrix  (T). 


4.  The  transformation  matrix  T  is  formed  in  the  following  manner: 


c;.4> 


C[AV' 


(B-  3) 


Cl  A  - 1 


CM"1' 


where  the  ith  constructibility  index.  V,.  is  the  smallest  positive  integer  (greater 


than  or  equal  to  one)  so  that  C,A  l'*  1  is  a  linear  combination  of  the  row  before  it. 
For  example,  if  the  following  four  rows  were  examined: 


V 

v 

•5 

? 


ij 


and  CXA 


and  C\A  4  is  a  linear  combinations  of  the  previous  rows,  then  Yl  =  3  . 


5.  Ensure  that  Vj  >  V2  >  V3  >  ...V).  If  this  is  not  true,  then  permutate  the 


output  matrix  (C)  to  satisfy  this  requirement.  Also  verify  that  \  )  +1 2  4-...  +  V  —l  — 


6.  Now  define  the  following  matrices: 


C  =  CT ~ 


B  =  TB 


7.  Form  the  Ai  coefficients  bv: 


A,  =  C Sq,(k  -  i) 


where 


(*-l)  0  0 

(k  -  2) 


Sp,{k)  = 


{k  ~  Yj )  ; 

0  (k-  1) 

:  (*-2) 


(k-V3)  i 
0  (k  —  1) 

:  (*  -  2) 


(*  - »/) 


(5-4) 


(5-5) 


(5-6) 


(5-7) 


,,0, 


For  example,  to  generate  Ai.  the  Spj  matrix  needs  to 
be  formed.  The  Sp\  matrix  is  formed  by  setting  the  ”k-l” 
elements  of  Sp  to  1  and  all  the  other  elements  would  be  set 
to  zero. 

8.  Form  the  B,  coefficients  by: 


Bt  =  CSqt_  j  ( k  -  i)B 

where 

Sq  =  S'-'D'.x  =  max  V, 

and 

5  is  block-diagonal  Toeplitz  given  by: 


5,  = 


0  " 
0  > 


(B-8) 


5,  =  i...(r,xr,) 

The  MATRIX-A'  macro  used  to  implement  this  procedure  are  shown  and 


explained  in  the  next  section. 


e 


# 


m 
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B.3  Autoregressive  Macros 

The  three  macros  used  to  calculated  the  coefficients  of  the 
autoregressive  model  are  presented  in  this  section.  The  macros  are  first 
shown  in  the  matrix  format  and  then  they  are  shown  in  a  expanded  format 
with  comments  added.  Use  of  these  macros  to  generate  the  autoregressive 
model  for  the  plants  contained  in  this  thesis  are  shown  in  the  next 
section . 

B.3.1  ARMAMODEL.  This  macro  generates  the  construtability  matrix 
(Co)  introduced  in  the  previous  section. 

CLEAR  CO ,C0=<C»INV (AD) > ;F0R  I=2:N,C0=<C0;C*INV(AD)*i>;END,>TMAT<; 

CLEAR  CO,  : Clearing  the  previous  construtability  matrix. 

C0=<C»INY(AD)> ;  :Forming  the  first  row  of  the  construtability 
matrix . 

FOR  1=2 : N ,  : Loop  for  forming  the  construtability  matrix. 

CO=<CO ;C*INV (AD) **I> ; 

END, 

>TMAT<;  :  Executing  the  macros  TMAT. 


2.  TMAT.  Forms  the  temporary  transformation  matrix  (T)  from  the 
independent  rows  of  Co. 

V1=0;CR=0; CLEAR  TT, CLEAR  R,  TT=<C0(1 , :)>;R=TT;F0R  I  =  2:2*N, 


R=<TT;C0(I, :)>;  RN=RANK(R) ;  IF  RN=I-CR  THEN  TT=R ; ELSEIF  RN<I-CR  THEN 


R=TT ; V I  =  < V 1 ;I> ;Vl=VI ;CR=CR+1 ;END , END , T=R , CO , ; 


V1=0;  initializing  temporary  vector. 
CR=0;  initializing  counter, 

CLEAR  TT,  : Clearing  temporary  vector. 
CLEAR  R,  : Clearing  temporary  vector. 


4 


B-5 


TT=<C0(1 , :Forming  first  row  of  TT. 

R=TT; 

FOR  I  =  2:2*N,  :Loop  for  generating  R,  which  becomes  the 
temporary  transfomation  matrix. 

R=<TT ; CO (I , : ) > ; 

RN=RANK(R) ; 

IF  RN=I-CR  THEN  TT=R; 

ELSEIF  RN<I-CR  THEN  R=TT; 

VI=<V1;I>; 

V1=VI; 

CR=CR+1 ; 

END, 

END, 

T=R, 

CO,; 

3.  BARS.  Generates  A,  B,  and  C  from  a  transformation  matrix  (TF) .  The 
transformation  matrix  must  contain  the  independent  rows  of  Co  in  the 
order  shown  in  Equation  (B-3) . 

CBAR=C*INV (TF) ; ADBAR=TF  *  AD* INV (TF ) ;BDBAR=TF*BD;H=CBAR*BDBAR, ; 
CBAR=C*INV (TF) ; 

ADBAR = TF  *  AD  * INV ( TF ) ; 

BDBAR=TF*BD; 

H=CBAR*BDBAR,  ;  -.Step-response  matrix,  also  Bl . 


B.4  Autoregressive  Calculations 


•i 

$ 

3 


This  section  uses  the  macros  explained  in  the  previous  section  to 
generate  the  autoregressive  coefficients  for  the  three  models  used  in 


this  thesis. 


B.4.1  Plant  1.  Calculation  of  the  autoregressive  model  for 
the  first  nominal  plant.  The  output  vector  for  the  first  plant  consist 
of  flight-path  angle,  beta,  and  yaw  rate. 
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-2 . 5165D-01 
-6 . 2089D-03 


-6 . 7267D-09 
1.9249D-01 
3.7363D-08 
-2.0165D-06 
O.OOOOD-OO 
O.OOOOD-OO 
O.OOOOD-OO 
O.OOOOD-OO 


JARMAMODEL"  -  Invoking  the  macro  ARMAMODEL 
T 


COLUMNS 
9  9999D-01 
O.OOOOD-OO 
O.OOOOD-OO 
9.9998D-01 
O.OOOOD-OO 
O.OOOOD-OO 
9 . 9997D-01 
9.9996D-01 


1  THRU 
4 . 6324D-07 
O.OOOOD-OO 
O.OOOOD-OO 
9 . 3572D-07 
O.OOOOD-OO 
O.OOOOD-OO 
1 .4208D-06 
1 .9218D-06 


-1 .0150D-00 
O.OOOOD-OO 
O.OOOOD-OO 
-1 .0301D-00 
O.OOOOD-OO 
O.OOOOD-OO 
-1 .0456D-00 
-1 .0612D-00 


2 . 2320D-05 
O.OOOOD-OO 
O.OOOOD-OO 
1 .9555D-04 
O.OOOOD-OO 
O.OOOOD-OO 
5 . 2321D-04 
1 . 0089D-03 


O.OOOOD-OO 
-3.4554D-04 
1 .2505D-05 
O.OOOOD-OO 
-6 . 9197D-04 
5.0096D-05 
O.OOOOD-OO 
O.OOOOD-OO 


O.OOOOD-OO 

1.0030D-00 

-7.2551D-02 

O.OOOOD-OO 

1.0051D-00 

-1.4542D-01 

O.OOOOD-OO 

O.OOOOD-OO 


B-8  ■ 


COLUMNS  7  THRU  8 
O.OOOOD+OO  O.OOOOD+OO 
-3.2821D-04  1.0010D-02 

2.4756D-04  1.0033D+00 

O.OOOOD+OO  O.OOOOD+OO 
-6.6072D-04  2.0083D-02 

5.2662D-04  1.0058D+00 

O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 

Checking  to  make  sure  the  constructibility  indices  are  in  the 
correct  order. 

VI 

0. 

8. 

9. 

11 . 

12. 

13. 

14. 

15. 

16. 


Vl=4,  V2=2  and  V3=2;  This  is  in  the  proper  order. 


Forming  the 

transformation  matrix  TF 

(T  Final) . 

<>  TF= [T(l , 

:) ;T(4, :) ;T(7, : ) ; T (8 , : ) ; T (2 , : ) ; T (5 , : 

) ;T(3, : ) ; T (6 , 

o:  ! 

1 

TF 

= 

1 

COLUMNS 

1  THRU  6 

1 

9 . 9999D-01 

4 . 6324D-07  -1.0150D+00 

2 . 2320D-05 

O.OOOOD+OO 

O.OOOOD+OO 

9 . 9998D-01 

9.3572D-07  -1.0301D+00 

1 . 9555D-04 

O.OOOOD+OO 

O.OOOOD+OO 

9 . 9997D-01 

1.4208D-06  -1.0456D+00 

5 . 2321D-04 

O.OOOOD+OO 

O.OOOOD+OO 

9 . 9996D-01 

1.9218D-06  -1.0612D+00 

1 .0089D-03 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

-3 . 4554D-04 

1.0030D+00 

O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

-6 . 9197D-04 

1.0051D+00 

O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

1 . 2505D-05  - 

7 . 2551D-02 

0 . OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

5 . 0096D-05  - 

1.4542D-01 

COLUMNS 

7  THRU  8 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

-3 . 2821D-04 

1.0010D-02 

-6 . 6072D-04 

2.0083D-02 

2 . 4756D-04 

1 .0033D+00 

5 . 2662D-04 

1 .0058D+00 

B-9 
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]BARS[  -  Invoking  the  macro  BARS 


BDBAR 

7.5172D-04 
7 . 5124D-04 
7.3257D-04 
6.9529D-04 
-1 . 1336D-05 
3 . 2105D-05 
6 . 4398D-03 
6.4775D-03 

ADBAR 

COLUMNS 
3 . 9774D+00  - 
1 . OOOOD+OO 
-9 . 8255D-14 
3.7947D-13  - 
0. OOOOD+OO 
0. OOOOD+OO 
0. OOOOD+OO 
0 . OOOOD-OO 

COLUMNS  7 
0. OOOOD+OO 
0. OOOOD+OO 
0. OOOOD+OO 
0 . OOOOD-OO 
1 .4340D-02 
-3.0791D-17 
1  9693D+00 
1 . OOOOD-OO 

CBAR 

COLUMNS 
3 . 9774D-00  - 
0. OOOOD+OO 
0. OOOOD-OO 

COLUMNS  7 
0. OOOOD+OO 
1 .4340D-02 
1  9693D+00 


7 . 5172D-04 
7 . 5124D-04 
7 . 3257D-04 
6 . 9529D-04 
1 . 1336D-05 
-3 . 2105D-05 
-6 . 4398D-03 
-6.4775D-03 


1.2342D-03 
1 . 2495D-03 
1 . 2601D-03 
1 .2660D-03 
-3 . 5314D-06 
-2 . 5069D-05 
6 . 2903D-03 
6 . 3751D-03 


1 . 2342D-03 
1 .2495D-03 
1 .2601D-03 
1 .2660D-03 
3.5314D-06 
2 . 5069D-05 
-6 . 2903D-03 
-6.3751D-03 


4 . 4474D-08 
1 . 3450D-07 
2 . 2663D-07 
3 . 2150D-07 
0. OOOOD+OO 
0. OOOOD+OO 
0. OOOOD+OO 
0. OOOOD+OO 


1  THRU 
5.9319D+00 
1.9779D-13 
1. OOOOD+OO 
7 . 9003D-13 
0. OOOOD-OO 
0. OOOOD+OO 
0. OOOOD-OO 
0. OOOOD-OO 

THRU  8 
0  OOOOD-OO 
0. OOOOD-OO 
0. OOOOD+OO 
0. OOOOD+OO 
-1 . 4252D-02 
4 . 7705D-18 
-9 . 6938D-01 
4 . 1633D-17 


3.9316D-00 
9 . 6020D-14 
-3 . 9568D- 13 
1 . OOOOD-OO 
0. OOOOD-OO 
0. OOOOD-OO 
0. OOOOD-OO 
0. OOOOD-OO 


-9.7709D-01 
-1.2722D-13 
8 . 3267D-15 
-4 . 9594D-13 
0. OOOOD-OO 
0  OOOOD-OO 
0. OOOOD+OO 
0. OOOOD+OO 


0. OOOOD+OO 
0. OOOOD+OO 
0. OOOOD+OO 
0. OOOOD-OO 
1 .9951D+00 
1 .OOOOD+OO 
7 . 3194D-02 
-8.6736D-18 


0. OOOOD+OO 
0. OOOOD+OO 
0. OOOOD+OO 
0. OOOOD+OO 
-9.9707D-01 
2 . 6522D-17 
-7 . 1 142D-02 
6.9389D-18 


1  THRU  6 

5 . 9319D-00  3 . 9316D+00  -9.7709D-01 
0. OOOOD-OO  0. OOOOD-OO  0. OOOOD-OO 
0. OOOOD+OO  0. OOOOD+OO  0. OOOOD-OO 


0. OOOOD-OO 
1 .9951D+00 
7.3194D-02 


0. OOOOD+OO 
-9 . 9707D-01 
-7 . 1 142D-02 


THRU  8 
0  OOOOD-OO 
-1  . 4252D-02 
-9 . 6938D-01 


Now  the  "B"  coefficients  are  formed. 


B1ARMA=CBAR*BDBAR 


B1ARMA 

7 . 3442D-04 

7.3442D-04 

1.2143D-03 

1 . 2143D-03 

-4.4090D-08 

-5.4597D-05 

5.4597D-05 

1 .7295D-05 

-1 . 7295D-05 

O.OOOOD+OO 

6.3994D-03 

-6 . 3994D-03 

6 . 2089D-03 

-6.2089D-03 

O.OOOOD+OO 

B2ARMA=CBAfi . SQ.BDBAR 


B2ARMA 

= 

-2.2213D-03 

-2.2213D-03 

-3 . 6398D-03 

-3 . 6398D-03 

4.3557D-08 

-8.0478D-05 

8.0478D-05 

-8 . 6128D-05 

8 . 6128D-05 

O.OOOOD+OO 

-6 . 2418D-03 

6 . 2418D-03 

-6.0974D-03 

6.0974D-03 

O.OOOOD+OO 

B3ARMA=CBAR *  SQ  *  *  2 »  BDBAR 

B3ARMA 

= 

2.2214D-03 

2.2214D-03 

3.6314D-03 

3. 6314D-03 

4.3432D-08 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

B4ARMA=CBAR 

*SQ*  *3*BDBAR 

B4ARMA 

= 

-7 . 3450D-04 

-7 . 3450D-04 

-1 .2059D-03 

-1 .2059D-03 

-4 . 3455D-08 

0 . 0000D-00 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

Now  the  "A" 

coefficients 

are  formed. 

SP1 

= 

1 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

0. 

1. 

0 

0. 

0. 

0 

0. 

0. 

1 

0. 

0. 

0 

B  —  1 1 


c 


A1ARMA=-CBAR»SP1 

A1ARMA 

-3.9774D+00  O.OOOOD+OO 
O.OOOOD+OO  -1 .9951D+00 
O.OOOOD+OO  -7 . 3194D-02 


O.OOOOD+OO 
-1.4340D-02 
-1 . 9693D+00 


SP2 


0. 

0. 

0 

1. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

* 

0. 

0. 

0 

0. 

1. 

0 

0. 

0. 

0 

0. 

0. 

1 

A2ARMA=- 

CBAR* 

SP2 

A2ARM.4 

- 

5 . 9319D+00 
O.OOOOD+OO 
O.OOOOD+OO 

SP3 


O.OOOOD+OO 
9 . 9707D-01 
7 . 1 142D-02 


O.OOOOD+OO 
1 .4252D-02 
9 . 6938D-01 


0. 

0. 

0 

0. 

0. 

0 

1  . 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

A3ARMA=-CBAR*SP3 

A3ARMA 

-3 . 9316D+00  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
0 . OOOOD-OO  O.OOOOD+OO 

SP4 


O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 


( 


0. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

1 . 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

B  —  1 2 


k  .  • 


A4ARMA= - CBAR  *  SP4 


A4ARMA 

9.7709D-01  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

Calculating  the  steady-state  transfer  function  (GO) . 

The  denominator  of  GO  is  labled  GODEN. 

G0DEN= [EYE (3) +A1ARMA+A2ARMA+A3ARMA+A4ARMA] 

GODEN 

-9 . 2837D-10  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO  1 . 9329D-03  -8.8330D-05 

O.OOOOD+OO  -2.0513D-03  9.7068D-05 

The  numerator  of  Go  is  labled  GON. 

G0N=  '  B 1 ARMA  * B2 ARMA - B3 ARMA + B4ARMA] 

GON 

-1.0057D-08  -1.0057D-08  -2.9606D-09  -2.9606D-09  -5.5669D-10 

-1 . 3508D-04  1 . 3508D-04  -6.8833D-05  6.8833D-05  O.OOOOD+OO 

1 . 5762D-04  -1 . 5762D-04  1.1149D-04  -1.1149D-04  O.OOOOD+OO 

GO-INV (GODEN) *G0N 

GO 

1.0833D+01  1.0833D+01  3.1891D+00  3.1891D+00  5.9964D-01 

1 . 2604D-01  -1 . 2604D-01  4.9232D-01  -4.9232D-01  O.OOOOD+OO 

4 . 2874D+00  -4.2874D+00  1.1553D+01  -1.1553D+01  O.OOOOD+OO 

Checking  GO  agianst  -C*INV(A)*B 

-C*INV (A) *B  = 

1.0834D+01  1.0834D+01  3.1894D+00  3.J894D+00  5.9969D-01 

1 . 2604D-01  - 1 . 2604D-01  4.9232D-01  -4.9232D-01  O.OOOOD+OO 

4 . 2874D+00  -4.2874D+00  1.1553D+01  -1.1553D+01  O.OOOOD+OO 


e 


B.4.2  Plant  2.  Calculation  of  the  autoregressive  model  for 
the  second  plant.  The  output  vector  for  this  plant  consist  of  forward 
velocity,  beta,  and  yaw  rate. 


* 

A 

= 

COLUMNS 

1  THRU  ( 

3 

O.OOOOD-OO 

O.OOOOD+OO 

O.OOOOD+OO 

1 . 0000D+00 

O.OOOOD+OO 

O.OOOOD+OO 

-3 . 2183D+01 

-5 . 6009D-02 

3 . 8291D+01 

-3  0138D+01 

O.OOOOD+OO 

O.OOOOD+OO 

-1 . 1000D-03 

4.5971D-05 

-1 .4845D+00 

9 . 9480D-01 

O.OOOOD+OO 

O.OOOOD+OO 

* 

3 . 0000D-04 

-2. 1010D-03 

4.2717D+00 

-7 . 7720D-01 

0.0000D+00 

O.OOOOD+OO 

0 . OOOOD-OO 

0 . OOOOD-OO 

0.  OOOOD-OO 

O.OOOOD+OO 

0.0000D+00 

O.OOOOD+OO 

0.00000*00 

0. OOOOD-OO 

O.OOOOD+OO 

O.OOOOD+OO 

3 . 4500D-02 

-3.4536D-01 

0 . OOOOD-OO 

0. OOOOD-OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

-5 . 5253D+01 

0 . OOOOD-OO 

0 . OOOOD-OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

7 . 2370D+00 

a* 

COLUMNS 

7  THRU  8 

0  OOOOD-OO 

0 . OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

0 . OOOOD-OO 

0 . OOOOD-OO 

0 . OOOOD-OO 

0 . OOOOD-OO 

1 . OOOOD-OO 

O.OOOOD+OO 

tf 

3 . 2600D-02 

-9 . 9760D-01 

-2.8004D-00 

1 . 4570D-01 

-2 . 3200D-02 

-3 . 6250D-01 

O.OOOOD+OO 

0. OOOOD-OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

1 .0030D+00 

1.0030D+00 

1 . 1584D+00 

1 .1584D+00 

1 . 9254D+01 

7 . 4600D-02 

-7 . 4600D-02 

-1 .2250D-01 

-1 .2250D-01 

O.OOOOD+OO 

1 . 2029D+01 

-1 . 2029D+01 

-3 . 2363D+00 

-3 . 2363D+00 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

3 . 3000D-03 

3 . 3000D-03 

7 . OOOOD-04 

-7. OOOOD-04 

O.OOOOD+OO 

6 . 3395D+00 

-6 . 3395D+00 

2 . 5519D+01 

-2 . 5519D+01 

O.OOOOD+OO 

6 . 4200D-01 

n 

-6 . 4200D-01 

6 . 2490D-01 

-6.2490D-01 

O.OOOOD+OO 

0.  1. 

0.  0. 

0 

0.  0. 

0. 

0.  0. 

0.  0. 

0 

1 .  0. 

0. 

0.  0. 

0.  0. 

0 

0.  0. 

1 . 

RANK(R) ;  IF  RN=I-CR  THEN  TT=R;ELSEIF  RN<I-CR  THEN  R=TT;VI=<V1 ;I>;Vl=VI; 
CR=CR+1;END,END,T=R,C0, ; 

<>  ] ARMAMODEL [ 


• 

T 

= 

COLUMNS 

1  THRU  6 

3.2192D-01 

1.0006D+00  -3.9236D-01 

3.0296D-01 

O.OOOOD+OO 

O.OOOOD+ 

O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

-3.4554D-04 

1.0030D+ 

O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

1.2505D-05 

7.2551D- 

« 

6 . 4401D-01 

l.OOllD+OO  -8.0392D-01 

6.0924D-01 

O.OOOOD+OO 

O.OOOOD+ 

O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

-6.9197D-04 

1.0051D+ 

, 

O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

5.0096D-05 

-1.4542D- 

1 

9 . 6629D-01 

1.0017D+00  -1 . 2351D+00 

9 . 1906D-01 

O.OOOOD+OO 

O.OOOOD+ 

1 . 2887D+00 

1.0023D+00  -1 . 6864D+00 

1 . 2326D+00 

O.OOOOD+OO 

O.OOOOD+ 

COLUMNS 

7  THRU  8 

5 

O.OOOOD+OO 

O.OOOOD+OO 

, 

-3 . 2821D-04 

1.0010D-02 

2.4756D-04 

1.0033D+00 

O.OOOOD+OO 

O.OOOOD+OO 

-6 . 6072D-04 

2.0083D-02 

5 . 2662D-04 

1.0058D+00 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

Checking  to 

make  sure  that  the  constructibility 

indices  are 

in  the 

• 

proper  order 
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FORMING  THE  TRANSFORMATION  MATRIX  TF  (T  FINAL) 

TF= [T(l , : ) ;T(4 , : ) ;T(7 , : ) ;T(8, : ) ;T(2, : ) ;T(5, : ) ;T(3, : ) ;T(6 , : ) ] 


TF 


COLUMNS 

1  THRU  6 

3 . 2192D-01 

1 .0006D+00  -3.9236D-01 

3 . 0296D-01 

0. OOOOD+OO 

0. OOOOD+OO 

6 . 4401D-01 

1 .0011D+00  -8.0392D-01 

6 . 0924D-01 

0. OOOOD+OO 

0. OOOOD+OO 

9 . 6629D-01 

1 . 0017D+00  -1 . 2351D+00 

9. 1906D-01 

0. OOOOD+OO 

0. OOOOD+OO 

1 .2887D+00 

1 . 0023D+00  -1 . 6864D+00 

1 . 2326D+00 

0. OOOOD+OO 

0. OOOOD+OO 

0 . OOOOD+OO 

0. OOOOD +00  0. OOOOD+OO 

0. OOOOD+OO 

-3 . 4554D-04 

1.0030D+00 

0 . OOOOD+OO 

0. OOOOD +00  0. OOOOD +00 

0. OOOOD +00 

-6 . 9197D-04 

1 . 0051D+00 

0. OOOOD +00 

O.OOOCD+OO  0. OOOOD+OO 

0. OOOOD+OO 

1 . 2505D-05 

-7 . 2551D-02 

0. OOOOD +00 

0. OOOOD+OO  0. OOOOD+OO 

0. OOOOD+OO 

5 . 0096D-05 

-1 . 4542D-01 

COLUMNS 

7  THRU  8 

0. OOOOD+OO 

0. OOOOD+OO 

0 . OOOOD+OO 

0. OOOOD +00 

0 .  OOOOD  *  00 

0. OOOOD+OO 

0. OOOOD +00 

0. OOOOD -00 

-3 . 2821D-04 

1 . 0010D-02 

-6 . 6072D-04 

2 . 0083D-02 

2.4756D-04 

1 .0033D+00 

5 . 2662D-04 

1 . 0058D+00 

BARS  = 


CBAR=C*INV (TF) ;ADBAR=TF»AD*INV(TF) ; BDBAR=TF *BD ; H=CBAR*BDBAR , ;  <> 
: BARS  [ 


H 

2 . 7952D-02 

2 . 7952D-02 

1 .6210D-02 

1 .6210D-02 

1 . 9249D-01 

-5 . 4597D-05 

5 . 4597D- 05 

1 .7295D-05 

-1 .7295D-05 

0. OOOOD+OO 

6.3994D-03 

-6 . 3994D-03 

6 . 2089D-03 

-6 . 2089D-03 

0. OOOOD+OO 

BDBAR 

= 

-8.0117D-03 

-8.0117D-03 

6 . 931 9D-03 

6 . 9319D-03 

1 .9259D-01 

-4 . 4347D-02 

-4.4347D-02 

-2 . 4270D-03 

-2 . 4270D-03 

1 .9270D-01 

-8 . 1080D-02 

-8 . 1080D-02 

-1 . 1873D-02 

-1 .1873D-02 

1 .9281D-01 

-1 . 1824D-01 

-1 . 1824D-01 

-2. 1413D-02 

-2. 1413D-02 

1 .9293D-01 

-1 .1336D-05 

1 .1336D-05 

-3 . 5314D-06 

3 . 5314D-06 

0 . OOOOD+OO 

3 . 2105D-05 

-3 . 2105D-05 

-2 . 5069D-05 

2 . 5069D-05 

0. OOOOD+OO 

6 . 4398D-03 

-6 . 4398D-03 

6 . 2903D-03 

-6 . 2903D-03 

0. OOOOD+OO 

6 . 4775D-03 

-6 . 4775D-03 

6 . 3751D-03 

-6 . 3751D-03 

0. OOOOD+OO 

ADBAR 


w 

COLUMNS 

1  THRU  ( 

3 

1  ", 

3.9774D+00 

-5 . 9319D+00 

3 . 9316D+00 

-9 . 7709D-01 

O.OOOOD+OO 

O.OOOOD+OO 

>  , 

1 .OOOOD+OO 

-2 . 2737D-13 

2.2737D-13 

-5 . 6843D- 14 

O.OOOOD+OO 

O.OOOOD+OO 

l  ", 

4.5475D-13 

1 .OOOOD+OO 

1 . 1369D-12 

-3 . 4106D-13 

O.OOOOD+OO 

O.OOOOD+OO 

r*. 

6 . 8212D-13 

-1 .3642D-12 

1 .OOOOD+OO 

-3.4106D-13 

O.OOOOD+OO 

O.OOOOD+OO 

# 

0 . OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

1 .9951D+00 

-9 . 9707D-01 

J 

0 . OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

1 . OOOOD+OO 

2 . 6522D-17 

5-: 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

7 . 3194D-02 

-7 . 1142D-02 

£ 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

0 . OOOOD+OO 

-8 . 6736D-18 

6 . 9389D-18 

COLUMNS 

7  THRU  8 

V 

0 . OOOOD+OO 

0.0000D-00 

i 

0 . OOOOD+OO 

O.OOOOD+OO 

a 

0 . OOOOD+OO 

O.OOOOD+OO 

V 

0 . OOOOD+OO 

O.OOOOD+OO 

g 

1 .4340D-02 

-1.4252D-02 

r* 

-3.0791D-17 

4 . 7705D-18 

>N 

1 .9693D+00 

-9 . 6938D-01 

1 .OOOOD-OO 

4 . 1633D-17 

t: 


Now  forming  the  "B1'  coefficients. 


E 


K . 


B1ARMA1=  CBAR-BDBAR 


B1ARMA1 

— 

2 . 7952D-02 

2 . 7952D-02 

1 .6210D-02 

1 . 6210D-02 

1 .9249D-01 

-5 . 4597D-05 

5 . 4597D-05 

1 .7295D-05 

-1.7295D-05 

O.OOOOD+OO 

6 . 3994D-03 

-6 . 3994D-03 

6 . 2089D-03 

-6 . 2089D-03 

O.OOOOD+OO 

SQ 


0. 

0. 

0. 

0. 

0. 

0. 

0. 

0 

1 . 

0. 

0. 

0. 

0. 

0. 

0. 

0 

0. 

1 . 

0. 

0. 

0. 

0. 

0. 

0 

0. 

0. 

1 . 

0. 

0. 

0. 

0. 

0 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0 

0. 

0. 

0. 

0. 

1 . 

0. 

0. 

0 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0 

0. 

0. 

0. 

0. 

0. 

0. 

1 . 

0 

B2ARMA 1 =CBAR »  SQ  *  BDBAR 
B2ARMA1 


-4.7607D-02  -4.7607D-02 
-8.0478D-05  8.0478D-05 
-6.2418D-03  6.2418D-03 
B3ARMA 1 =CBAR »  S  Q  *  *  2  *  BDBAR 


-3 . 9060D-02 
-8 . 6128D-05 
-6.0974D-03 


-3.9060D-02 
8 . 6128D-05 
6.0974D-03 


-5.7321D-01 

O.OOOOD+OO 

O.OOOOD+OO 


B3ARMA1 


1 . 1833D-02  1 . 1833D-02 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
B4ARMA 1 =CBAR ♦ S Q  * »  3  * BDBAR 


2 . 9625D-02 
O.OOOOD+OO 
O.OOOOD+OO 


2.9625D-02 

O.OOOOD+OO 

O.OOOOD+OO 


5.6891D-01 
O.OOOOD+OO 
0 . OOOOD+OO 


B4ARMA1 


7 . 8281D-03 
0 . OOOOD+OO 
O.OOOOD+OO 


7.8281D-03 

O.OOOOD+OO 

O.OOOOD+OO 


-6.7731D-03 
0 . OOOOD+OO 
O.OOOOD+OO 


-6.7731D-03 

O.OOOOD+OO 

O.OOOOD+OO 


-1 .8818D-01 
O.OOOOD+OO 
O.OOOOD+OO 


Now  forming  the  "A"  coefficients. 
SP1 


i. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

< 

0. 

1 . 

0 

i 

0. 

0. 

0 

• 

0. 

0. 

1 

* 

0. 

0. 

0 

A1ARMA1=-CBAR*SP1 

A1ARJ1A1 


-3 . 9774D+00  O.OOOOD+OO 
O.OOOOD+OO  -1.9951D+00 
O.OOOOD+OO  -7.3194D-02 


O.OOOOD+OO 
-1 .4340D-02 
-1 . 9693D+00 


SP2 


0. 

0. 

0 

1 . 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

0. 

0. 

0 

0. 

1 . 

0 

0. 

0. 

0 

0. 

0. 

1 

B-18 


A2ARMA1=-CBAR*SP2 


A2AR14A1 

5. 9319D+00  O.OOOOD+OO 
O.OOOOD+OO  9.9707D-01 
O.OOOOD+OO  7 . 1142D-02 

SP3 

0.  0.  0. 

0.  0.  0. 

1.  0.  0. 

0.  0.  0. 

0.  0.  0. 

0.  0.  0. 

0.  0.  0. 

0.  0.  0. 

A3ARMA1=-CBAR*SP3 

A3ARMA1 

-3 . 9316D+00  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 

SP4 


0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

1. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

A4ARMA1=-CBAR*SP4 


A4ARMA1 

9 . 7709D-01  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 


O.OOOOD+OO 
1.4252D-02 
9 . 6938D-01 


O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 


O.OOOOD+ 

0.0000D+ 

O.OOOOD+ 


8§§ 


Now  calculating  the  steady-state  transfer  funciton  (Go) 
The  denominator  of  Go  is  labled  Goden. 


G0DEN= [EYE (3) +A1ARMA1 -A2ARMA1 - A3ARMA1 -A4ARMA1 ] 


GODEN 

-9 . 2829D-10  0. OOOOD-OO  0. OOOOD-OO 
0. 0000D+00  1.9329D-03  -8.8330D-05 
0. OOOOD-OO  -2.0513D-03  9.7068D-05 


The  numerator  of  Go  is  labled  GON 


GON  =  [Bl ARMA1 -B2ARMA1 -B3ARMA1 -B4ARMA1 ] 
GON 


5 . 7875D-06 
-1 .3508D-04 

1 .5762D-04 

5 . 7875D-06 

1 .3508D-04 
-1 .5762D-04 

1 .6963D-06 
-6.8833D-05 

1 . 1149D-04 

1 .6963D-06 

6 . 8833D-05 
-1.1149D-04 

8.0958D-10 
0. OOOOD-OO 
0 . OOOOD-OO 

G0=INV (GODEN) 

•GON 

GO 

-6 . 2346D-03 

1 . 2604D-01 

4 . 2874D-00 

-6 . 2346D-03 
-1 .2604D-01 
-4 . 2874D-00 

-1 . 8273D-03 
4.9232D-01 

1 . 1553D-01 

-1 .8273D-03 
-4 . 9232D-01 
-1 . 1553D-01 

-8 . 7212D-01 
O.OOOOD+OO 
0. OOOOD-OO 

Checking  Go  against  -C*INV(A)*B 

-C-INV (A) »B  = 

-6.2346D-03 

1 .2604D-01 

4 . 2874D-00 

-6 . 2346D-03 
-1 .2604D-01 
-4 . 2874D-00 

-1 .  8273D+03 

4 . 9232D-01 

1 . 1553D+01 

-1 .8273D-03 
-4 . 9232D-01 
-1 .1553D-01 

-8 . 7212D-01 
0. OOOOD-OO 
0. OOOOD-OO 

B.4.3  Plant  3.  Calculation  of  the  autoregressive  model  for 
the  failed  plant.  The  output  vector  for  this  plant  consist  of  forward 
velocity,  beta,  and  yaw  rate.  The  left  elevator  effectiveness  is  reduced 
by  5051.  This  is  accomplished  by  multipling  the  corresponding  B  column 
of  the  healthy  model  by  0.50. 

A 


0.0000 

0.0000 

0.0000 

1.0000 

0.0000 

0.0000 

0.0000 

0.0000 

32.1830 

-0.0560 

38 . 2906 

-30.1376 

0.0000 

0.0000 

0.0000 

0.0000 

-0.0011 

0.0000 

-1.4845 

0.9948 

0.0000 

0.0000 

0.0000 

0.0000 

0.0003 

-0.0021 

4.2717 

-0.7772 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

C  0000 

0.0000 

0.0000 

0.0000 

0.0000 

1.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0345 

-0.3454 

0.0326 

-0.9976 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

-55.2526 

-2 . 8004 

0.1457 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

7.2370 

-0.0232 

-0.3625 

B 

= 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0. 5015 

1 .0030 

1.1584 

1.1584 

19.2540 

-0.0373 

-0.0746 

-0.1225 

-0.1225 

0.0000 

6.0145 

-12.0291 

-3.2363 

-3.2363 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

-0.0016 

0.0033 

0.0007 

-0.0007 

0.0000 

3.1698 

-6.3395 

25.5186 

-25.5186 

0.0000 

0.3210 

-0.6420 

0.6249 

-0.6249 

0.0000 

C 

= 

0.  1 . 

0. 

0.  0. 

0.  0. 

0. 

0.  0. 

0. 

0.  0. 

1.  0. 

0. 

0.  0. 

0. 

0.  0. 

0.  0. 

1 . 

] BARS ; 

BDBAR 

- 

-4.0058D-03  -8.0117D 
-2.2174D-02  -4.4347D 
-4.0540D-02  -8.1080D 
-5.9119D-02  -1.1824D 
-5 . 6678D-06  1.1336D 
1 . 6053D-05  -3.2105D 
3 . 2199D-03  -6.4398D 
3 . 2388D-03  -6.4775D 


03 

6 . 9319D-03 

6 

02 

-2 . 4270D-03 

-2 

02 

-1 . 1873D-02 

-1 

01 

-2. 1413D-02 

-2 

05 

-3 . 5314D-06 

3 

05 

-2 . 5069D-05 

2 

03 

6 . 2903D-03 

-6 

03 

6 . 3751D-03 

-6 

9319D-03  1 . 9259D-01 
4270D-03  1.9270D-01 
1873D-02  1 . 9281D-01 
1413D-02  1 . 9293D-01 
5314D-06  O.OOOOD-OO 
5069D-05  O.OOOOD^OO 
2903D-03  O.OOOOD-OO 
3751D-03  0 . OOOOD-OO 


B1AR1AA2=CBAR*  BDBAR 


B1ARMA2 

= 

1 . 3976D-02 
-2.7299D-05 
3. 1997D-03 

2 . 7952D-02 
5.4597D-05 
-6 . 3994D-03 

1 . 6210D-02 
1.7295D-05 
6.2089D-03 

1 .6210D-02 
-1 . 7295D-05 
-6 . 2089D-03 

1 .9249D-01 
0. OOOOD-OO 
0. OOOOD-OO 

B2ARMA2=CBAR*SQ« BDBAR 

B2ARMA2 

= 

-2 . 3803D-02 
-4 . 0239D-05 
-3 . 1209D-03 

-4 . 7607D-02 
8.0478D-05 
6.2418D-03 

-3 . 9060D-02 
-8 . 6128D-05 
-6 . 0974D-03 

-3 . 9060D-02 
8. 6128D-05 
6 . 0974D-03 

-5.7321D-01 
0. OOOOD-OO 
0. OOOOD-OO 

B3ARMA2=CBAR » SQ • • 2 - BDBAR 

B3ARMA2 

- 

5 . 91 63D-03 
0. OOOOD-OO 
0. OOOOD-OO 

1 . 1833D-02 
0. OOOOD-OO 
0. OOOOD-OO 

2 . 9625D-02 

0 . OOOOD-OO 
0. OOOOD-OO 

2. 9625D-02 
0.  OOOOD-OO 
0. OOOOD-OO 

5.6891D-01 
0. OOOOD-OO 
0. OOOOD-OO 

B4ARMA2-CBAR  *  SQ • • 3 -  BDBAR 

B4ARMA2 

= 

3 . 9141D-03 

0 . OOOOD-OO 

0 . OOOOD-OO 

7 . 8281D-03 
0. OOOOD-OO 
0. OOOOD-OO 

-6 . 7731D-03 
0. OOOOD-OO 
0. OOOOD-OO 

-6 . 7731D-03 
0. OOOOD-OO 
0 . OOOOD-OO 

-1 . 8818D-01 
0. OOOOD-OO 
0. OOOOD-OO 

The 

second  plant 

numerator  of 

the  steady-state  transfer 

function  for 

GN= [B1ARMA2-B2ARMA2-B3ARMA2-B4ARMA2] 

GN 

= 

2 . 8937D-06 
-6 . 7538D-05 

7 . 8808D-05 

5 . 7875D-06 

1 .3508D-04 
-1 .5762D-04 

1 . 6963D-06 
-6 . 8833D-05 

1 . 1149D-04 

1 . 6963D-06 

6 . 8833D-05 
-1 . 1149D-04 

8.0958D-10 
0. OOOOD-OO 
0. OOOOD-OO 

The  steady-state 

transfer  function  for  the 

second  plant 

lab led  G02. 


G02=INV(G0DEN) »GN 


-3 . 1173D-03 

-6 . 2346D+03 

-1 .8273D-03 

-1 . 8273D-03 

-8 . 7212D-01 

6.3021D-02 

-1 .2604D-01 

4 . 9232D-01 

-4 . 9232D-01 

O.OOOOD-OO 

2 . 1437D*00 

-4.2874D-00 

1 . 1553D+01 

-1 . 1553D-01 

O.OOOOD-OO 

The  steady  state  transfer  function  could  have  been  calculating 
by  taking  the  corresponding  column  of  the  healthy  steady-state  transfer 
function  (GO  below)  and  multipling  it  by  0.50.  That  is,  for  this  second 
plant  the  first  column  of  GO  would  be  multiplied  by  0.50  and  that  would 
generate  the  steady-state  transfer  function  G02  shown  above. 

GO 

-6.2346D-3  -6.2346D+03  -1.8273D-03  -1.8273D+03  -8.7212D-01 

1 . 2604D-01  -1 . 2604D-01  4.9232D-01  -4.9232D-01  O.OOOOD-OO 

4 . 2874D-00  -4. 2874D-00  1.1553D»01  -1.1553D-01  0.0000D-00 


Checking  G02  against  -C*INV(A)*B 
-C-INV (A) *B  - 

-3. 1173D-03  -6 . 2346D*03  -1.8273D-03  -1.8273D-03  -8.7212D-01 
6 . 3021D-02  -1 . 2604D-01  4.9232D-01  -4.9232D-01  0.0000D-00 
2 . 1437D-00  -4 . 2874D+00  1.1553D*01  -1.1553D*01  0.0000D-00 


Appendix  C:  Estimation  A lqgrithm  Equations 

C.l  Introduction 

This  appendix  contains  the  equations  used  in  Reference  2.  It  is  explained  in 
Reference  2  that  these  equations  are  solved  m  (number  of  outputs)  times  per  time 
step. 

C.2  Equation  Listing 

At  time  kT  (k  >  0  .  where  0  is  initiation  time)  calculate  for  1=1 . m 

e;  =  e;_,(*r)  =  ~kr)pt(kT)vt(kT)i,(kT)  (c  -  1) 

where 

i ,{kT)  is  the  estimated  prediction  error 

\\(kT)  is  the  estimated  prediction  error  variance 
P,(kT )  is  the  estimated  parameter  covariance  matrix 
vt{kT)  is  the  ilh  column  of  measurements  in  T (kT) 
with  initial  conditions 

©q(0)  initial  presumed  values  of  the  step-response  matrix  elements 

I’,(0)  initial  presumed  value  for  prediction  error  variance  for  1=1....  m 

P0(0)  estimated  covariance  of  the  parameter  estimates  at  initiation  time 

r,(0)  vector  of  past  measurements  prior  to  initiation  of  identification  for  i  =  1 .. . .  m 

with  design  parameters 

"a"  desired  variance  of  the  parameter  estimates 

*'1.~|2.';  rO  design  parameters  for  a  fault  detection  scheme 

*/3.r.  rl  design  parameters  of  the  prediction  error  variance  estimator 

and  recursive  relationships  (in  proper  order  of  ocurrence 


* 


* 


# 


Q'-)(kT)  =  eim  (k  -  1)7] 

(r  -  2) 

=  y/(W)  -  vJ(kT\ei,.i(kT)  +  n,(*7) 

(C-3) 

P0(^r)  =  Pm(k  —  1)7 

(C-4) 

Vt(kT)  =  i  j (kT)P,  ,  (/r7)t  ,(Ar7) 

(C-5) 

Vt{kT)  =  vJ(kT)P'  ]{kT)v,(kT) 

(C-6) 

b~i 

-V 

-ie: 

cT 

-ic 

SL 

ii 

S' 

-2< 

(C-7) 

/  n-T)  -  1  f'»(A'r)  „ 

',d  ]  /j,(kf)  [n,\kT) 

(C  -  S) 

rO(kT)  =  rm  {k  -  1)7] 

(C  -9) 

'•3r,[(/r  -  l)rj  -r  (1  -  ^3)^(kT  -  r)  if  r,_}{kT)  <  rl 
V,ikT)=  '  (C  -  10) 

(  Y,[{k  -  l)7j  if  r,_ j  (kT)  >  rl 


a  [kT]  -  V  l(kT)  - _ ) _ 

'd  }  '  '  '  C,  AkT)rh{kT)-\ 


(C-ll) 


e 


aAkT)  = 


0  if  a,d(kT)  <  0 

o,  (kT)  ifO  <  a,  (kT)  < 


l  _ 
nJ*T) 

0 


r i,l  kT) 


if 


W  +  J* t, 


if  °id  >  f  ,  (^)  *  I?1  ( i- 7~ J 


(C  -  12) 


C-2 


e 


r.O(Jtr)  =  1  - 


K(kT)  +  [1 


vAkT) 

-at(kT)Yt(kT)}Vt(kT) 


(C  -  13) 


3,(kT)  = 


0 


if  r,_  j  ( kT )  <  rO 
if  r,  j  (kT)  >  rO 


(C-14) 


P  -  i(kT ! 


i(^) 


p,_i(^r)vf(fcr)flr (kTjP'-^kT)  , 

!»'•;  r(*r)  -  o,(JrT)]-'  +  i|, (AT)  ^  3  '' 


(C  -  IS) 


♦ 


a 


c 


C-3 


€ 


Appendix  D:  Macro  Lisitings 

D. 1  Introduction 

This  appendix  contains  two  sections.  The  first  section  shows  the 
procedure  used  to  verify  the  assumptions  made  in  Chapter  III.  The  second 
section  shows  and  explains  the  macros  used  in  foming  the  open-loop  and 
closed-loop  transfer  function  when  the  controller,  actuators,  and  plant 
are  in  series. 

D . 2  Assumptions  Verification 

In  this  section  the  assumptions  made  in  Chapter  III  are  verified. 

This  is  done  by  first  presenting  the  plant  matrices  and  then  MATRIX  is  used 

x 

to  determine  the  eigenvalues,  check  the  rank  of  C*B,  check  the  observability 
and  controllability  of  the  plant,  and  finally  to  verify  that  the 
tranmission  zeros  do  not  lie  in  the  right-half  plane. 

PLANT  MATRICES  (0.9M,  20,000  ft) 

The  continuous  plant  matrix  (A) : 


COLUMNS  1  THRU 
0.0000D+00  O.OOOOD+OO 
-3.2183D+01  -5.6009D-02 
-1 . 1000D-03  4.5971D-05 
3.0000D-04  -2. 1010D-03 
O.OOOOD+OO  0.0000D+00 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 

COLUMNS  7  THRU 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
1.0000D+00  O.OOOOD+OO 
3 . 2600D-02  -9 . 9760D-01 

-2.8004D+00  1 . 4570D-01 

-2.3200D-02  -3 . 6250D-01 


O.OOOOD+OO  1 . 0000D+00 
3 . 8291D+01  -3.0138D+01 
-1.4845D+00  9 . 9480D-01 
4.2717D+00  -7.7720D-01 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 


O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
O.OOOOD+OO  O.OOOOD+OO 
3.4500D-02  -3.4536D-01 
O.OOOOD+OO  -5.5253D +01 
O.OOOOD+OO  7.2370D+00 


The  continuous  input  matrix  (B) : 


0.0000D+00 
1 . 0030D+00 
-7.4600D-02 
-1 . 2029D+01 
O.OOOOD+OO 
-3.3000D-03 
6 . 3395D+00 
6 , 4200D-01 


O.OOOOD+OO 
1 .0030D+CX) 
-7.4600D-02 
-1 . 2029D+01 
O.OOOOD+OO 
3.3000D-03 
-6.3395D+00 
-6.4200D-01 


O.OOOOD+OO 
1 . 1584D+00 
-1.2250D-01 
-3. 2363D+00 
0. OOOOD^OO 
7 . OOOOD-04 
2 . 5519D+01 
6.2490D-01 


0.00000*00 
1 . 1584D+00 
-1 . 2250D-01 
-3.2363D+00 
O.OOOOD+OO 
-7. 0000D-04 
-2.5519D+01 
-6.2490D-01 


O.OOOOD+OO 

1.9254D+01 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 


The 

continuous 

output 

matrix 

(C): 

1 . 

0. 

-1  . 

0. 

0. 

0. 

0. 

0 

0. 

0. 

0. 

0. 

0. 

1 . 

0. 

0 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

1 

EIGENVALUES 


Checking  the  eigenvalues  of  the  A  matrix 
EIG(A)  = 


-0.0473 
-0.0473 
1 .0119 
3.2350 
-0.3917 
-0.3917 
-2.6977 
-0.0272 


0. 1626i 
0. 1 626  i 
O.OOOOi 
O.OOOOi 
2 . 9615i 
2 . 9615i 
O.OOOOi 
O.OOOOi 


plane . 


As  mentioned  in  Chapter  III,  there  is  one  pole  in  the  right-half 


RANK  OF  C*B 

Verifying  that  C*B  has  full  rank. 


C  +  B  = 


0.0746  0.0746  0.1225  0.1225  0.0000 
-0.0033  0.0033  0.0007  -0.0007  0.0000 
0.6420  -0.6420  0.6249  -0.6249  0.0000 


RANK(C*B)  =  3. 


OBSERVABILITY  and  CONTROLLABILITY 


Verifying  that  the  plant  is  observable  and  controllable.  A  system 
matrix  needs  to  be  form.  The  system  matrix  S  is: 


S  = 


where 


0.  0.  0.  0. 

D  =  0.  0.  0.  0. 

0.  0.  0.  0. 

S=  [A ,  B ;  C ,  D] 

S 

COLUMNS  1  THRU  8 


0.0000 

0.0000 

0.0000 

1.0000 

0.0000 

0.0000 

0.0000 

0.0000 

-32.1830 

-0.0560 

38 . 2906 

-30.1376 

0.0000 

0.0000 

0.0000 

0.0000 

-0.0011 

0.0000 

-1.4845 

0.9948 

0.0000 

0.0000 

0.0000 

0.0000 

0.0003 

-0.0021 

4.2717 

-0.7772 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

1.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0345 

-0.3454 

0.0326 

-0.9976 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

-55.2526 

-2.8004 

0.1457 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

7.2370 

-0.0232 

-0.3625 

1 .0000 

0.0000 

-1.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

1 .0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

1.0000 

COLUMNS  9  THRU  13 


0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

1.0030 

1.0030 

1.1584 

1.1584 

19.2540 

-0.0746 

-0.0746 

-0.1225 

-0.1225 

0.0000 

-12.0291 

-12.0291 

-3.2363 

-3.2363 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

-0.0033 

0.0033 

0.0007 

-0.0007 

0.0000 

6 . 3395 

-6.3395 

25.5186 

-25.5186 

0.0000 

0.6420 

-0.6420 

0.6249 

-0.6249 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

First,  verifying  that  the  number  of  observable  states 

equal  8. 

[SOB , NSOB] =OBSERVABLE(S , 8) 

NSOB  =  8. 

Now,  verifying  that  the  number  of  states  controllable  equal  8. 

[SCN , NSCN] =CNTRLABLE (S , 8) 

NSCN  =  8 . 

Verifying  that  controllability  of  the  plant  due  to  integral  action 
is  maintained.  First  R  is  formed  as  specified  in  Chapter  III,  then  the 
rank  of  R  is  checked. 

<>  R=[B,A;D,C] ;  RANK(R) 

The  rank  of  R  is  11,  as  required.  This  controllability  is  also  checked 
by  verifying  that  the  rank  of  GO  is  equal  to  the  number  of  outputs  . 
<>RANK(-C*INV (A) *B) 

The  rank  of  GO  is  3  as  required. 

TRANSMISSION  ZEROS 

Verifying  that  there  are  no  transmission  zeros  in  the  right-half 

plane . 

<>  ZEROS (S, 8) 

THIS  SYSTEM  HAS  NO  TRANSMISSION  ZEROS 

CONCLUSIONS 

None  of  the  assumptions  listed  in  Chapter  III  are  violated. 


D-4 


La. 


D.3  Transfer  Function  Calculation 

This  section  presents  and  explains  the  macros  use  to 
determine  the  open-loop  and  close-loop  transfer  function  generate  by  the 
series  combination  of  the  controller  and  plant.  The  macro  used  to 
generate  root  locus  plots  is  also  presented  and  explained. 

There  were  three  macros  used,  the  first  called  PCONT  was  used 
to  determine  the  continuous  transfer  functions.  The  second  macro, 
called  PCLOSE,  was  used  to  determine  the  discrete  transf erf unctions . 

Finally  the  last  one  (PACT)  was  used  to  determine  the  transfer  functions 
when  the  actuators  were  added  to  the  system.  The  first  macros  (PCONT) 
is  then  shown  as  it  appears  when  used  in  MATRIX  .  This  macro  is  then 
separated  into  individual  commands  and  comments  are  made  to  explain 
the  purpose  of  these  commands.  The  two  remaining  macros  are  then  displayed 
and  only  the  difference  between  them  and  the  first  macro  is  esplained. 

PCONT 

CLEAR  Kl, CLEAR  K2,S=<A,B;C,D>;F0R  1=1:5, FOR  J=2 : 3 , Kl (I , J) =HI (I , J) 

. SIGMA ( J , 1 ) ; EN  D , END , K2=G0 ’ .INV (GO* GO ’ ) .RHO ; K1 ; K2 ; NUMCNTRL=<K1 , K2> ; 
DENCNTRL=<1 , 0> ; <SCTRL , NSCTRL>=SFORM (NUMCNTRL , DENCNTRL , 3) ; <S0PL , NS0PL>= 
SERIES (SCTRL , NSCTRL , S , NS) ; <NUM0PL , DEN0PL>=TF0RM (SOPL , NSOPL) ; <A0PL , B0PL>= 
SPLIT (SOPL , NSOPL) ; <SCL , NSCL>=FEEDBACK (SOPL , NSOPL) ; <NUMCL , DENCL>= 

TFORM (SCL , NSCL) ; P0L=PVA (AOPL) ;<ACL,BCL>=SPLIT(SCL,NSCL) ;PCL=PVA(ACL) ; 

CLEAR  Kl ,  -  Initialize  Kl 

CLEAR  K2,  -  Initialize  K2 

S=<A,B;C,D>;  -  Form  the  system  matrix 

FOR  1=1:5,  -  Loop  used  for  the  rows  of  Kl 

FOR  J=l:3,  -  Loop  used  for  the  columns  of  K2 

Kl (I , J) =HI (I , J) *SIGMA(J, 1) ;  -  Forming  Kl ,  using  the  inverse  of 

the  step-response  matrix. 


END,  -  End  of  first  loop 
END,  -  End  of  second  loop 

K2=G0 ’ *INV(GO*G0 ’) *RH0 ;  -  Forming  K2,  using  the  steady-state 

transfer  funtion  and  Rho 

K1 ;  -  Display  K1  if  desired 

K2;  -  Display  K2  if  desired 

NUMCNTRL=<K1 ,K2> ;  -  Form  numerator  of  controller  transfer  function 

DENCNTRL=<1 ,0> ;  -  Form  denominator  of  controller  transfer  function 

<SCTRL , NSCTRL>=SFORM (NUMCNTRL , DENCNTRL , 3) ;  -  Form  the  system  matrix 

of  the  controller 

<SOPL,NSOPL>=SERIES(SCTRL,NSCTRL,S,NS) ;  -  Form  the  open-loop  system 

matrix 

<NUM0PL, DEN0PL>=TF0RM (SOPL, NSOPL) ;  -  Form  the  numerator  and 

denominator  of  the  open-loop 
transfer  function 

<A0PL, B0PL>=SPLIT (SOPL, NSOPL) ;  -  Obtain  the  A  and  B  matrices  of  the 

open-loop  system 

<SCL , NSCL>=FEEDBACK (SOPL , NSOPL) ;  -  Form  a  unity  feedback  closed-loop 

system 

<NUMCL,DENCL>=TFORM(SCL,NSCL) ;  -  Obtain  the  numerator  and  denominator 

of  the  close-loop  transfer  function 


P0L=PVA(A0PL) ;  -  Eigenvalues  of  the  open-loop  system 

<ACL,BCL>=SPLIT(SCL,NSCL) ;  -  Obtain  the  A  and  B  matrices  of  the 

closed-loop  system 

PCL=PVA(ACL) ;  -  Eignevalues  of  the  closed-loop  system 

PCLOSE 

CLEAR  Kl, CLEAR  K2,S=<A,B;C,D>;SD=DISC(S,NS,TSAMP) ;<AD,BD>=SPLIT(SD,NS) ; 

FOR  1=1: 5, FOR  J=1 : 3,K1 (I , J)=HI (I , J) *  SIGMA (J , 1) ;END,END ,K2=G0 ’ *INV (G0*G0 ’) 
*RB0;K1 ;K2;NUMCNTRL=<K1 ,K2> ;DENCNTRL=<1 ,0> ; <SCNTRL,NSCTRL>=SFORM (NUMCNTRL, 
DENCNTRL , 3) ; <SDCTRL , NSDCTRL>=DISC (SCNTRL , NSCTRL , TSAMP) ; <S0PL , NS0PL>= 

SERIES (SDCTRL , NSDCTRL , SD , NS) ; <NUM0PL , DEN0PL>=TF0RM (SOPL , NSOPL) ; <A0PL , B0PL>= 
SPLIT (SOPL , NSOPL) ; <SCL , NSCL>=FEEDBACK (SOPL , NSOPL) ; <NUMCL , DENCL>= 

TF0RM(SCL , NSCL) ;P0L=PVA(A0PL) ;<ACL,BCL>=SPLIT(SCL,NSCL) ;PCL=PVA(ACL) ; 


e 


The  PCLOSE  macro  discretizes  the  plant  and  controller  to 
obtain  the  pole  location  in  the  Z  plane. 


CLEAR  Kl, CLEAR  K2,S=<A,B;C,D>;F0R  I=1:5,F0R  J=1 : 3 ,K1 (I , J) =HI (I , J) *SIGMA ( J , 1 ) 
; END , END , K2-G0 ’ * INV (GO  *  GO ’ ) *RH0 ; Kl ; K2 ; NUMCNTRL=<K1 , K2> ; DENCNTRL=< 1 , 0> ; 

<SCTRL , NSCTRL>=SFORM (NUMCNTRL , DENCNTRL , 3) ; <SCA , NSCA>=SERIES (SCTRL , NSCTRL , 

S5 , 9) ; <S0PL , NSOPL  >=SERIES (SCA , NSCA , S , NS) ; <NUM0PL , DEN0PL>=TF0RM (SOPL , NSOPL) ; 
<A0PL , B0PL>=SPLIT (SOPL , NSOPL) ; <SCL , NSCL>=FEEDBACK (SOPL , NSOPL) ; < 

NUMCL , DENCL>=TFORM (SCL , NSCL) ; P0L=PVA (AOPL) ; <ACL , BCL>=SPLIT (SCL , NSCL) ; 
PCL-PVA(ACL) ; 

The  above  PACT  macro  adds  the  actuator  system  matrix  (SCA)  in  series 
with  the  controller  and  plant. 


Appendix  E:  MATRIX  v  Simulation 

Introduction 

This  appendix  contains  the  MATRIX*  system  block  diagram  representation 
and  interconnection  of  the  simulations  conducted  for  this  thesis.  The  block 
diagram  is  shown  first,  follwed  by  the  interconnection  data  for  the  approriate  block 
diagram.  The  simulation  blocks  are  presented  in  the  following  order: 

SYSTEM  BLOCK 
A/C  BLOCK 

SERVOS  BLOCK 
ADAPT2  BLOCK 
CTRL  BLOCK 
B  MAT  BLOCK 
A  MAT  BLOCK 
LMTINT  BLOCK 
SERV02  BLOCK 


INTERCONNECTION  FOR  SUPER-BLOCK  "SYSTEM" 


<BUILD>  Summing  Junction  :  IN  SUM 
SIGNS 

1.  -1. 


Inputs  :  6  Outputs  :  3 

<BUILD>  Super-Block  :  ADAPT2 

Inputs  :  12  Outputs  :  300 

<BUILD>  Super-Block  :  CTRL 

Inputs  :  33  Outputs  :  5 

<BUILD>  Super-Block  :  A/C 

Inputs  :  6  Outputs  :  20 

<BUILD>  Linear  Dynamic  System  :  OUTMAT 
S 


States  :  0 


States  :  0 


Outputs  :  5 


States  :  0 


States  :  0 


0. 

1. 

0. 

0. 

0. 

0. 

0. 

0 

0. 

0. 

0. 

0. 

0. 

1 . 

0. 

0 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

1 

Inputs  :  8 

Block  location  :  1 


Outputs  :  3 


States  :  0 


INPUTS 

II 

OUTPUTS 

From 

Name  Location 

1 

To 

II 

From  | 

Name  Location 

To 

( 

1) 

External 

Input 

! 

1 

1  1 

1  | 

ADAPT2  2 

(  1) 

1 

II 

1 

External  Output 

(329) 

( 

2) 

External 

Input 

1 

2 

II 

2  1 

ADAPT2  2 

(  2) 

1 

II 

1 

External  Output 

(330) 

( 

3) 

External 

Input 

1 

3 

1  1 

3  1 

ADAPT2  2 

(  3) 

1 

1  1 

1 

External  Output 

(331) 

( 

1) 

OUTMAT 

6 

t 

4 

1  1 

( 

2) 

OUTMAT 

6 

i 

5 

1  1 

( 

3) 

OUTMAT 

6 

i 

6 

1  1 

Block  location  :  2 


INPUTS 


OUTPUTS 


£ 


* 


* 


I 


* 


* 


e 


c 


From 

Name  Location 

To 

( 

1) 

IN  SUM 

1 

1 

( 

2) 

IN  SUM 

1 

2 

( 

3) 

IN  SUM 

1 

3 

( 

1) 

OUTMAT 

6 

4 

( 

2) 

OUTMAT 

6 

5 

( 

3) 

OUTMAT 

6 

6 

( 

1) 

A/C 

4 

7 

( 

2) 

A/C 

4 

8 

( 

3) 

A/C 

4 

9 

( 

4) 

A/C 

4 

10 

( 

5) 

A/C 

4 

11 

( 

4) 

External 

Input 

12 

From  | 

Name  Location 

To 

1 

1 

A/C  4 

(  6) 

1 

External  Output 

(  1) 

2 

1 

CTRL  3 

(  1) 

! 

External  Output 

(  2) 

3 

1 

CTRL  3 

(  2) 

1 

External  Output 

(  3) 

4 

! 

CTRL  3 

(  3) 

1 

External  Output 

(  4) 

5 

1 

CTRL  3 

(  4) 

1 

External  Output 

(  5) 

6 

1 

CTRL  3 

(  5) 

1 

External  Output 

(  6) 

7 

1 

CTRL  3 

(  6) 

1 

External  Output 

(  7) 

8 

1 

CTRL  3 

(  7) 

1 

External  Output 

(  8) 

9 

1 

CTRL  3 

(  8) 

1 

External  Output 

(  9) 

10 

1 

CTRL  3 

(  9) 

1 

External  Output 

(  10) 

11 

1 

CTRL  3 

(  10) 

1 

External  Output 

(  11) 

12 

1 

CTRL  3 

(  ID 

1 

External  Output 

(  12) 

13 

1 

CTRL  3 

(  12) 

1 

External  Output 

(  13) 

14 

1 

CTRL  3 

(  13) 

1 

External  Output 

(  14^ 

15 

1 

CTRL  3 

(  14) 

1 

External  Output 

(  15) 

16 

1 

CTRL  3 

(  15) 

1 

External  Output 

(  16) 

17 

1 

CTRL  3 

(  16) 

1 

External  Output 

(  17) 

18 

1 

CTRL  3 

(  17) 

1 

External  Output 

(  18) 

19 

1 

CTRL  3 

(  18) 

1 

External  Output 

(  19) 

20 

1 

CTRL  3 

(  19) 

1 

External  Output 

(  20) 

21 

1 

CTRL  3 

(  20) 

1 

External  Output 

(  21) 

22 

1 

CTRL  3 

(  21) 

1 

External  Output 

(  22) 

23 

1 

CTRL  3 

(  22) 

E-A 


1 

External 

Output 

(  23) 

24 

1 

CTRL 

3 

(  23) 

1 

External 

Output 

(  24) 

25 

1 

CTRL 

3 

(  24) 

1 

External 

Output 

(  25) 

26 

1 

CTRL 

3 

(  25) 

1 

External 

Output 

(  26) 

27 

1 

CTRL 

3 

(  26) 

1 

External 

Output 

(  27) 

28 

1 

CTRL 

3 

(  27) 

1 

External 

Output 

(  28) 

29 

1 

CTRL 

3 

(  28) 

1 

External 

Output 

(  29) 

30 

I 

CTRL 

3 

(  29) 

1 

External 

Output 

(  30) 

31 

1 

CTRL 

3 

(  30) 

1 

External 

Output 

(  31) 

32 

1 

CTRL 

3 

(  31) 

1 

External 

Output 

(  32) 

33 

1 

CTRL 

3 

(  32) 

1 

External 

Output 

(  33) 

34 

1 

CTRL 

3 

(  33) 

1 

External 

Output 

(  34) 

35 

1 

External 

Output 

(  35) 

36 

1 

External 

Output 

(  36) 

37 

1 

1 

1 

External 

Output 

(  37) 

300 

1 

1 

1 

External 

Output 

(300) 

Block  location  :  3 

INPUTS 


From 

Name  Location 

( 

2) 

ADAPT2 

2 

( 

3) 

ADAPT2 

2 

( 

4) 

ADAPT2 

2 

( 

5) 

ADAPT2 

2 

( 

6) 

ADAPT2 

2 

( 

7) 

ADAPT2 

2 

( 

8) 

ADAPT2 

2 

( 

8) 

ADAPT2 

2 

OUTPUTS 


1 

To  |  | 

- 

From  | 

Name  Location 

To 

]  I 

1  1 1 

1  | 

A/C 

4 

(  1) 

n 

1 

External 

Output 

(324) 

2  1  1 

2  1 

A/C 

4 

(  2) 

II 

1 

External 

Output 

(325) 

3  I  I 

3  I 

A/C 

4 

(  3) 

11 

1 

External 

Output 

(326) 

4  I  I 

4  I 

A/C 

4 

(  4) 

II 

1 

External 

Output 

(327) 

5  1  1 

5  1 

A/C 

4 

(  5) 

1  1 

1 

External 

Output 

(328) 

2 

2 

2 


6 

7 

8 


e 

(  10)  ADAPT2 

2 

1  9  |  | 

(  11)  ADAPT2 

2 

1  10  |  | 

(  12)  ADAPT2 

2 

1  11  II 

to 

(  13)  ADAPT2 

2 

1  12  |  1 

w 

(  14)  ADAPT2 

2 

1  13  I! 

(  15)  ADAPT2 

2 

1  14  |  | 

(16)  ADAPT2 

2 

1  15  |  j 

(17)  ADAPT2 

2 

1  16  |  I 

(  18)  ADAPT2 

2 

1  17  1  | 

M 

(  19)  ADAPT 2 

2 

|  18  |  I 

V 

(  20)  ADAPT2 

2 

|  19  || 

(  21)  ADAPT2 

2 

1  20  |  | 

(  22)  ADAPT2 

2 

1  21  |  | 

(  23)  ADAPT2 

2 

I  22  |  | 

(  24)  ADAPT2 

2 

1  23  |  | 

a* 

(  25)  ADAPT2 

2 

1  24  |  | 

(  26)  ADAPT2 

2 

1  25  |  | 

(  27)  ADAPT2 

2 

1  26  |  | 

(  28)  ADAPT2 

2 

1  27  |  | 

(  29)  ADAPT2 

2 

1  28  || 

(  30)  ADAPT2 

2 

1  29  |  | 

(  31)  ADAPT2 

2 

1  30  |  | 

(  32)  ADAPT2 

2 

1  31  |  | 

(  33)  ADAPT2 

2 

1  32  |  | 

(  34)  ADAPT2 

2 

1  33  |  | 

Block  location  :  4 

« 

INPUTS 

II 

;  l 

OUTPUTS 

i  i 

From  Name  Location  j  To  | 

!  1 

From|  Name  Location 

To 

(  1)  CTRL 

3 

i  It 

1  |  ADAPT2  2 

(  7) 

1  1  1 

|  External  Output 

(301) 

(  2)  CTRL 

3 

1  2  |  | 

2  |  ADAPT2  2 

(  8) 

w 

1  II 

|  External  Output 

(302) 

(  3)  CTRL 

3 

1  3  |  | 

3  |  ADAPT2  2 

(  9) 

1  II 

|  External  Output 

(303) 

(  4)  CTRL 

3 

1  4  |  | 

4  |  ADAPT2  2 

(  10) 

1  II 

|  External  Output 

(304) 

(  5)  CTRL 

3 

1  5  |  | 

5  |  ADAPT2  2 

(  11) 

1  II 

)  External  Output 

(305) 

(  1)  ADAPT2 

2 

1  6  || 

6  |  External  Output 

(306) 

II 

7  j  External  Output 

(307) 

II 

8  |  External  Output 

(308) 

II 

9  j  External  Output 

(309) 

/ 

II 

10  |  OUTMAT  6 

(  1) 

's* 

II 

|  External  Output 

(310) 

1  1 

11  |  OUTMAT  6 

(  2) 

1  1 

|  External  Output 

(311) 

0 

E-6 

c 

1  TOSSSE 

12  |  OUTMAT  6  (  3) 

j  External  Output  (312) 

13  |  OUTMAT  6  (  4) 

I  External  Output  (313) 

14  |  OUTMAT  6  (  5) 

|  External  Output  (314) 

15  |  OUTMAT  6  (  6) 

j  External  Output  (315) 

16  |  OUTMAT  6  (  7) 

|  External  Output  (316) 

17  |  OUTMAT  6  (  8) 

j  External  Output  (317) 

18  j  External  Output  (318) 

19  j  External  Output  (319) 

20  |  External  Output  (320) 


Block  location  :  6 


INPUTS 

II 

OUTPUTS 

From 

Name 

Location 

To 

II 

From  | 

Name  Location 

To 

( 

10) 

A/C 

4 

1 

II 

1  | 

IN  SUM  1 

(  4) 

II 

1 

ADAPT2  2 

(  4) 

1  1 

1 

External  Output 

(321) 

( 

11) 

A/C 

4 

2 

1  1 

2  1 

IN  SUM  1 

(  5) 

1  I 

1 

ADAPT2  2 

(  S) 

1  1 

1 

External  Output 

(322) 

( 

12) 

A/C 

4 

3 

1  1 

3  1 

IN  SUM  1 

(  6) 

1  1 

1 

ADAPT2  2 

(  6) 

1 

External  Output 

(323) 

( 

13) 

A/C 

4 

4 

j  ' 

( 

14) 

A/C 

4 

5 

( 

15) 

A/C 

4 

6 

( 

16) 

A/C 

4 

7 

1  ! 

( 

17) 

A/C 

4 

8 

1  1 

C 


E-7 


INTERCONNECTION  FOR  SUPER-BLOCK  "A/C 


<BUILD>  Super-Block  : 

SERVOS 

Inputs  :  6 

Outputs  :  9 

States  :  0 

<BUILD>  Super-Block  : 

B  MAT 

|« 

Inputs  :  6 

Outputs  :  8 

States  :  0 

1 

<BUILD>  Summing  Junct 

ion  :  SUM 

| 

SIGNS 

|» 

1.  1. 

> 

Inputs  :  16 

Outputs  :  8 

States  :  0 

> 

it 

!r 

<BUILD>  Integrator  of 

GAIN 

Order  1  :  ST  INT 

V 

i’ 

,N 

X 

o 

II 

►— » 

1.  1.  1. 

1.  1. 

n* 

o 

o 

o 

0.  0.  0. 

0.  0. 

Inputs  :  8 

Outputs  :  8 

States  :  8 

1 

<BUILD>  Super-Block  : 

A  MAT 

■  * 

Inputs  :  9 

Outputs  :  8 

States  :  0 

$ 

Cn 

<BUILD>  Linear  Dynamic 

System  :  CMAT 

S 

S' 

0.  1.  0. 

0.  0.  0. 

0.  0. 

0.  0.  0. 

0.  0.  1. 

0.  0. 

K 

0.  0.  0. 

0.  0.  0. 

0.  1. 

Inputs  :  8 

Outputs  :  3 

States  :  0 

E-9 


Block  location  :  1 


«! 


INPUTS 

1  1 

OUTPUTS 

From 

Name  Location 

1 

To 

II 

From 

Name  Location 

To 

( 

1) 

External 

Input 

1 

1 

II 

1  | 

B  MAT 

2  ( 

1) 

1 

II 

1 

External 

Output  ( 

1) 

( 

2) 

External 

Input 

1 

2 

II 

2  1 

B  MAT 

2  ( 

2) 

I 

II 

1 

External 

Output  ( 

2) 

( 

3) 

External 

Input 

I 

3 

II 

3  1 

B  MAT 

2  ( 

3) 

! 

II 

1 

External 

Output  ( 

3) 

( 

4) 

External 

Input 

1 

4 

II 

4  I 

B  MAT 

2  ( 

4) 

1 

II 

1 

External 

Output  ( 

4) 

( 

5) 

External 

Input 

1 

5 

II 

5  1 

B  MAT 

2  ( 

5) 

1 

II 

1 

External 

Output  ( 

5) 

( 

6) 

External 

Input 

! 

6 

II 

8  I 

External 

Output  ( 

6) 

1  1 

7  1 

External 

Output  ( 

7) 

II 

8  1 

External 

Output  ( 

8) 

II 

9  I 

External 

Output  ( 

9) 

it- 

ion 

2 

INPUTS 

II 
!  1 

OUTPUTS 

From 

Name  Location 

1 

To 

I  ! 

I I 

From  | 

Name  Location 

To 

( 

1) 

SERVOS 

1 

! 

1 

1  ! 

1  1 

SUM 

3  ( 

1) 

( 

2) 

SERVOS 

1 

1 

2 

II 

2  1 

SUM 

3  ( 

2) 

( 

3) 

SERVOS 

1 

1 

3 

1  1 

3  I 

SUM 

3  ( 

3) 

( 

4) 

SERVOS 

1 

1 

4 

1  1 

4  I 

SUM 

3  ( 

4) 

( 

5) 

SERVOS 

1 

1 

5 

1  I 

5  I 

SUM 

3  ( 

5) 

( 

6) 

External 

Input 

1 

6 

1  1 

6  I 

SUM 

3  ( 

6) 

1  1 

7  I 

SUM 

3  ( 

7) 

1  1 

8  I 

SUM 

3  ( 

8) 

tion 

3 

INPUTS 

1  1 

OUTPUTS 

From 

Name  Location 

1 

To 

1  1 

From 

Name  Location 

To 

( 

1) 

B  MAT 

2 

1 

1 

1  1 

1  | 

ST  INT 

4  ( 

1) 

( 

2) 

B  MAT 

2 

1 

2 

II 

2  1 

ST  INT 

4  ( 

2) 

( 

3) 

B  MAT 

2 

1 

3 

1  1 

3  1 

ST  INT 

4  ( 

3) 

( 

4) 

B  MAT 

2 

! 

4 

II 

4  I 

ST  INT 

4  ( 

4) 

( 

5) 

B  MAT 

2 

1 

5 

II 

5  I 

ST  INT 

4  ( 

5) 

( 

6) 

B  MAT 

2 

1 

6 

II 

6  I 

ST  INT 

4  ( 

6) 

( 

7) 

B  MAT 

2 

1 

7 

II 

7  I 

ST  INT 

4  ( 

7) 

( 

8) 

B  MAT 

2 

1 

8 

1  1 

8  I 

ST  INT 

4  ( 

8) 

E-10 


INPUTS 


OUTPUTS 


(  1)  A  MAT  5 

(  2)  A  MAT  5 

(  3)  A  MAT  5 

(  4)  A  MAT  5 

(  5)  A  MAT  5 

(  6)  A  MAT  5 

(  7)  A  MAT  5 

(  8)  A  MAT  5 

Block  location  :  4 


9 

10 

11 

12 

13 

14 

15 

16 


Block  location  :  5 


INPUTS 


From 

Name  Location 

To 

1  1 

From  | 

Name 

Location 

To 

( 

1) 

ST  I  NT 

4 

1 

1  1 

1  | 

SUM 

3 

(  9) 

( 

2) 

ST  I  NT 

4 

2 

1  1 

2  I 

SUM 

3 

(  io) 

( 

3) 

ST  I  NT 

4 

3 

1  1 

3  I 

SUM 

3 

(  11) 

( 

4) 

ST  I  NT 

4 

4 

II 

4  I 

SUM 

3 

(  12) 

From 

Name 

Location  | 

To  || 

1  1 

From  | 

Name  Location 

To 

( 

1) 

SUM 

3  1 

!  1 
1  II 

1 

1 

A  MAT 

5 

(  1) 

1  1 

1 

CMAT 

6 

(  1) 

1  1 

1 

External 

Output 

(  10) 

( 

2) 

SUM 

3 

2  II 

2 

1 

A  MAT 

5 

(  2) 

II 

1 

CMAT 

6 

(  2) 

1  1 

1 

External 

Output 

(  ID 

( 

3) 

SUM 

3 

3  II 

3 

1 

A  MAT 

5 

(  3) 

1  1 

1 

CMAT 

6 

(  3) 

i  1 

1  1 

1 

External 

Output 

(  12) 

( 

4) 

SUM 

3 

4  1  I 

4 

1 

A  MAT 

5 

(  4) 

i  1 

i  1 

1 

CMAT 

6 

(  4) 

i 

1 

External 

Output 

(  13) 

( 

5) 

SUM 

3  ! 

5  !  | 

5 

1 

A  MAT 

5 

(  5) 

1  1 

1 

CMAT 

6 

(  5) 

| 

;  l 

1 

External 

Output 

(  14) 

( 

6) 

SUM 

3 

6  i  i 

6 

1 

A  MAT 

5 

(  6) 

i  1 

1 

CMAT 

6 

(  6) 

1  ! 

1 

External 

Output 

(  15) 

( 

7) 

SUM 

3 

7  il 

7 

1 

A  MAT 

5 

(  7) 

i  | 

1 

CMAT 

6 

(  7) 

i  1 

1 

External 

Output 

(  16) 

( 

8) 

SUM 

3 

8  II 

8 

1 

A  MAT 

5 

(  8) 

i  | 

1 

CMAT 

6 

(  8) 

1 1 

1 

External 

Output 

(  17) 

OUTPUTS 


INTERCONNECTION  FOR  SUPER-BLOCK  "SERVOS" 


e 


# 


* 


c 


« 


<BUILD>  Linear  Dynamic  System  :  B  SER 
S 


1000. 

0. 

0. 

0. 

0. 

1000. 

0. 

0. 

0. 

0. 

1000. 

0. 

0. 

0. 

0. 

1000. 

Inputs  :  4 

Outputs 

:  4 

States  : 

<BUILD>  Summing  Junction  :  SUM 
SIGNS 

1 .  1 . 

Inputs  :  8  Outputs  :  4  States  :  0 


BUILD>  Absolute  Saturation  Limit  :  R  LIM 
SATURATION  = 

90000.  90000.  90000.  90000. 

Inputs  :  4  Outputs  :  4  States  :  0 

<BUILD>  Super-Block  :  LMTINT 

Inputs  :  5  Outputs  :  8  States  :  0 


c 


E-14 


e 


Block  location  :  3 

INPUTS  | I  OUTPUTS 


From 

Name 

Location 

1  To  | 

1  From 

1 

Name  Location 

To 

* 

( 

1) 

sum 

2 

1  1 

i 

i  i  ; 

i  1 

LMTINT 

External 

4 

Output 

(  1) 
(  10) 

( 

2) 

SUM 

2 

2 

2 

LMTINT 

External 

4 

Output 

(  2) 

(  11) 

( 

3) 

SUM 

2 

3 

3 

LMTINT 

External 

4 

Output 

(  3) 
(  12) 

( 

4) 

SUM 

2 

4 

4 

LMTINT 

External 

4 

Output 

(  4) 

(  13) 

! 

I 


> 

> 

► 

r . 

i ' 


Block  location  :  4 


INPUTS 

OUTPUTS 

From 

Name  Location 

■ 

To 

i  ! 

i  1 

I  | 

From 

Name  Location 

To 

(  1) 

R  LIM 

3 

! 

1 

1  i 

1  I 

A  SER 

5  ( 

1) 

! 

!  1 

1 

External 

Output  ( 

1) 

(  2) 

R  LIM 

3 

1 

2 

!  1 

2  1 

A  SER 

5  ( 

2) 

1 

1 

External 

Output  ( 

2) 

(  3) 

R  LIM 

3 

i 

3 

1  1 

3  I 

A  SER 

5  ( 

3) 

1 

!  1 

1 

External 

Output  ( 

3) 

(  4) 

R  LIM 

3 

I 

4 

4  I 

A  SER 

5  ( 

4) 

I 

II 

1 

External 

Output  ( 

4) 

(  6) 

External 

Input 

! 

5 

1 1 

5  I 

External 

Output  ( 

6) 

1 1 

6  i 

External 

Output  ( 

7) 

II 

7  1 

External 

Output  ( 

8) 

1  1 

8  1 

External 

Output  ( 

9) 

Block 

location 

:  5 

INPUTS 

1  1 

OUTPUTS 

From 

Name  Location 

I 

To 

II 

1  ! 

From  | 

Name  Location 

To 

(  1) 

LMTINT 

4 

t 

1 

ii 

1  | 

SUM 

2  ( 

5) 

(  2) 

LMTINT 

4 

1 

2 

ii 

2  1 

SUM 

2  ( 

6) 

(  3) 

LMTINT 

4 

1 

3 

n 

3  1 

SUM 

2  ( 

7) 

(  4) 

LMTINT 

4 

1 

4 

ii 

4  1 

SUM 

2  ( 

8) 

Block 

location 

6 

INPUTS 

ii 

OUTPUTS 

From 

Name  Location 

1 

To 

ii 

From  | 

Name  Location 

To 

(  5) 

External 

Input 

! 

1 

ii 

1  1 

External  Output  ( 

5) 

INTERCONNECTION  FOR  SUPER-BLOCK  "ADAPT2" 


<BUILD>  Time  Delay  ->  z«*(-K)  :  DEL  Y 
K*TSAMP 
1 . 0000D-02 

Inputs  :  3  Outputs  :  3  States  :  3 

<BUILD>  Time  Delay  ->  z**(-K)  :  DEL  U 
K+TSAMP 
1.0000D-02 

Inputs  :  5  Outputs  :  5  States  :  5 

<BUILD>  User  Code  Function  Block  #1  :  ADAPT 

This  block  has  direct  feed-through  terms  (dY/dU  <>  0) 

RPAR 


COLUMNS 

1  THRU  6 

8 . 5000D-01 

9 . 5000D-01  5.0000D-04 

1 .OOOOD+02 

2 . 9000D+00 

COLUMNS 

7  THRU  12 

2 . OOOOD+OO 

1 . 0000D-02  1 . OOOOD+OO 

1 . 0000D-02 

5. OOOOD-Ol 

COLUMNS 

13  THRU  18 

1.0000D+02 

1.0000D-02  9 . 9000D+01 

1.0000D+06 

5 . OOOOD-03 

COLUMNS 

19  THRU  24 

2.5000D-01 

2.0000D-01  1.0000D-01 

1.0000D-01 

-9. OOOOD-Ol 

COLUMNS 

25  THRU  30 

9.0000D-01 

O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS 

31  THRU  36 

3.0000D-02 

3.0000D-03  9 . 5000D-02 

2 . OOOOD-Ol 

O.OOOOD+OO 

COLUMNS 

37  THRU  42 

O.OOOOD+OO 

2.0000D-01  O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS 

43  THRU  48 

O.OOOOD+OO 

6. OOOOD+OO  1.0000D+02 

1 . OOOOD+OO 

2. OOOOD+OO 

2. OOOOD+OO 

1.0000D-08 

l.OOOOD-12 

9.0000D-01 

O.OOOOD+OO 

O.OOOOD+OO 

2.0000D-01 

1 OOOOD+OO 


COLUMNS 

49  THRU 

54 

2.0000D+00 

3 .OOOOD+OO 

4. OOOOD+OO 

5.0000D+00 

2 . 7952D-02 

2.7952D-02 

COLUMNS 

55  THRU 

60 

1 .6210D-02 

1 .6210D-02 

1 . 9249D-01 

-5 . 4597D-05 

5 . 4597D-05 

1 . 7295D-05 

COLUMNS 

61  THRU 

66 

-1 .7295D-05 

O.OOOOD+OO 

6 . 3994D-03 

-6 . 3994D-03 

6 . 2089D-03 

-6.2089D-03 

COLUMNS 

67  THRU 

72 

O.OOOOD+OO 

-3 .9774D+00 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

-1.9951D+00 

COLUMNS 

73  THRU 

78 

-1.4340D-02 

0 . OOOOD+OO 

-7.3194D-02 

-1 . 9693D+00 

-4 . 7607D-02 

-4 . 7607D-02 

COLUMNS 

79  THRU 

84 

-3 . 9060D-02  - 

-3.9060D-02 

-5 . 7321D-01 

-8 . 0478D-05 

8 . 0478D-05 

-8. 6128D-05 

COLUMNS 

85  THRU 

90 

8 . 6128D-05 

0 . OOOOD+OO 

-6 . 2418D-03 

6 . 2418D-03 

-6 . 0974D-03 

6.0974D-03 

COLUMNS 

91  THRU 

96 

O.OOOOD+OO 

5 . 9319D+00 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

9 . 9707D-01 

COLUMNS 

97  THRU  102 

1 .42520-02 

0 . OOOOD+OO 

7 . 1 142D-02 

9 . 6938D-01 

1 . 1833D-02 

1 . 1833D-02 

COLUMNS 

103  THRU  108 

2 . 9625D-02 

2 . 9625D-02 

5 . 6891D-01 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS 

109  THRU  114 

0 . OOOOD+OO 

0 . OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS 

115  THRU  120 

0 . OOOOD+OO  - 

3.9316D+00 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS 

121  THRU  126 

0 . OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

7 . 8281D-03 

7 . 8281D-03 

COLUMNS 

127  THRU  132 

-6 . 7731D-03  - 

-6 . 7731D-03 

-1 .8818D-01 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS 

133  THRU  138 

0 . OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS 

139  THRU  144 

0 . OOOOD+OO 

9 . 7709D-01 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS 

145  THRU  150 

O.OOOOD+OO 

0. OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

1 .3978D-02 

2. 7957D-02 

E- 

-19 

V  v.  v 

v-v-v 

e 


i 


i 


1* 

» 

COLUMNS  151  THRU  156 

1 . 6214D-02  1 . 6214D-02  1.9253D-01 

-2 . 7299D-05 

5 . 4597D-05 

1 .7295D-05 

* 

f 

COLUMNS  157  THRU  162 
-1.7295D-05  O.OOOOD+OO  3.1997D-03 

-6 . 3994D-03 

6 . 2089D-03 

-6 . 2089D-03 

at 

COLUMNS  163  THRU  168 

O.OOOOD+OO  -3 . 9774D+00  O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

-1 .9951D+00 

COLUMNS  169  THRU  174 
-1.4340D-02  O.OOOOD+OO  -7.3194D-02 

-1 . 9693D+00 

-2 . 3807D-02 

-4 . 7613D-02 

i 

• 

COLUMNS  175  THRU  180 
-3 . 9068D-02  -3.9068D-02  -5.7334D-01 

-4 . 0239D-05 

8.0478D-05 

-8 . 6128D-05 

COLUMNS  181  THRU  186 

8 . 6128D-05  O.OOOOD+OO  -3.1209D-03 

6 . 2418D-03 

-6.0974D-03 

6.0974D-03 

r 

COLUMNS  187  THRU  192 

O.OOOOD+OO  5 . 9319D+00  O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

9 . 9707D-01 

COLUMNS  193  THRU  198 

1 . 4252D-02  O.OOOOD+OO  7.1142D-02 

9 . 6938D-01 

5 . 9157D-03 

1 . 1831D-02 

• 

COLUMNS  199  THRU  204 

2 . 9630D-02  2.9630D-02  5.6903D-01 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS  205  THRU  210 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

• 

COLUMNS  211  THRU  216 

O.OOOOD+OO  -3.9316D+00  O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS  217  THRU  222 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

3.9156D-03 

7 . 8311D-03 

< 

COLUMNS  223  THRU  228 
-6 . 7742D-03  -6.7742D-03  -1.8822D-01 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS  229  THRU  234 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

\ 

COLUMNS  235  THRU  240 

O.OOOOD+OO  9 . 7709D-01  O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

O.OOOOD+OO 

COLUMNS  241  THRU  246 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 

2.7957D-02 

2. 7957D-02 

c 


E-20 

C 


COLUMNS  247  THRU  252 
1 . 6214D-02  1 . 6214D-02  1.9253D-01 

COLUMNS  253  THRU  258 
-1.7295D-05  O.OOOOD+OO  6.3994D-03 

COLUMNS  259  THRU  264 
O.OOOOD-OO  -3 . 9778D+00  O.OOOOD-OO 

COLUMNS  265  THRU  270 
-1.4340D-02  O.OOOOD+OO  -7.3194D-02 

COLUMNS  271  THRU  276 
-3 . 9068D-02  -3.9068D-02  -5.7334D-01 

COLUMNS  277  THRU  282 
8 . 6128D-05  O.OOOOD+OO  -6.2418D-03 

COLUMNS  283  THRU  288 
O.OOOOD+OO  5 . 9332D+00  O.OOOOD+OO 

COLUMNS  289  THRU  294 
1 . 4252D-02  O.OOOOD+OO  7.1142D-02 

COLUMNS  295  THRU  300 
2 . 9630D-02  2.9630D-02  5.6903D-01 

COLUMNS  301  THRU  306 
O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

COLUMNS  307  THRU  312 
O.OOOOD+OO  -3 . 9329D+00  O.OOOOD+OO 

COLUMNS  313  THRU  318 
O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

COLUMNS  319  THRU  324 
-6.7742D-03  -6.7742D-03  -1.8822D-01 

COLUMNS  325  THRU  330 
O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

COLUMNS  331  THRU  336 
O.OOOOD+OO  9 . 7752D-01  O.OOOOD+OO 

COLUMN'S  337  THRU  340 
O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 


-5 . 4597D-05  5.4597D-05  1.7295D-05 

-6 . 3994D-03  6.2089D-03  -6.2089D-03 

O.OOOOD+OO  O.OOOOD+OO  -1.9951D+00 

- 1 . 9693D+00  -4 . 7613D-02  -4.7613D-02 

-8.0478D-05  8.0478D-05  -8.6128D-05 

6 . 2418D-03  -6 . 0974D-03  6.0974D-03 

O.OOOOD+OO  O.OOOOD+OO  9.9707D-01 

9 . 6938D-01  1 . 1831D-02  1.1831D-02 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO  7.8311D-03  7.8311D-03 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO  O.OOOOD+OO  O.OOOOD+OO 

O.OOOOD+OO 


e 


1 

COLUMNS 

1  THRU 

12 

1.  4. 

0. 

8. 

3.  1. 

0.  5 

1 

COLUMNS 

13  THRU 

17 

200.  0. 

0. 

1  . 

0. 

I  * 

5 

Inputs 

:  19 

Outputs  :  300 

States 

0.  20. 


Block  location  :  1 


INPUTS 


OUTPUTS 


From 

Name  Location 

i  To  j 
_  1 

i 

j  From 

Name 

Location 

To 

( 

6) 

External  Input 

i 

i  i  ; 

i  1 

I  ADAPT 

3 

(  12) 

( 

5) 

External  Input 

1  2  | 

1  2 

|  ADAPT 

3 

(  13) 

( 

4) 

External  Input 

3  | 

!  3 

!  ADAPT 

3 

(  14) 

Block  location 


INPUTS 


OUTPUTS 


# 

From 

Name  Location  ! 

To  | 

From 

Name  Location 

To 

( 

ID 

External 

Input  : 

1  i 

1  1 

ADAPT 

3 

(  7) 

( 

10) 

External  Input  : 

2 

2  i 

ADAPT 

3 

(  8) 

( 

9) 

External  Input 

3  h 

3  ■ 

ADAPT 

3 

(  9) 

( 

8) 

External 

Input  1 

4  i ; 

4 

ADAPT 

3 

(  io) 

• 

( 

7) 

External 

Input  | 

8  ,  ; 

5 

ADAPT 

3 

(  ID 

Block  locati 

on 

:  3 

INPUTS 

OUTPUTS 

i* 

From 

Name  Location  | 

To  I  j 
--  !  1 

From 

Name  Location 

To 

( 

1) 

External  Input  | 

1  1  ! 

1  i 

External 

Output 

(  1) 

( 

2) 

External 

Input  ! 

2  I  1 

2 

External 

Output 

(  2) 

( 

3) 

External 

Input  | 

3  I! 

3  i 

External 

Output 

(  3) 

( 

4) 

External 

Input  | 

4  1 

4  . 

External 

Output 

(  4) 

( 

5) 

External 

Input  | 

5  li 

5 

External 

Output 

(  5) 

( 

6) 

External 

Input 

6  |! 

6 

External 

Output 

(  6) 

( 

1) 

DEL  U 

2 

7  !  i 

7 

External 

Output 

(  7) 

( 

2) 

DEL  U 

2  I 

8  1! 

8 

External 

Output 

(  8) 

( 

3) 

DEL  U 

2  1 

9  I' 

9 

External 

Output 

(  9) 

( 

4) 

DEL  U 

2  1 

10  i; 

10 

External 

Output 

(  io) 

( 

5) 

DEL  U 

2  i 

11  1 

11 

External 

Output 

(  11) 

I 


( 

1) 

DEL  Y 

1  1 

12  | 

12 

External 

Output 

( 

12) 

( 

2) 

DEL  Y 

1  1 

13  | 

13 

|  External 

Output 

( 

13) 

( 

3) 

DEL  Y 

l  > 

14  1 

14 

!  External 

Output 

( 

14) 

( 

7) 

External 

Input  I 

15  | 

i  15 

S  External 

Output 

( 

15) 

( 

8) 

External 

Input 

16  | 

16 

External 

Output 

( 

16) 

( 

9) 

External 

Input  | 

17  | 

17 

j  External 

Output 

( 

17) 

( 

10) 

External 

Input  ! 

18  i  ! 

18 

External 

Output 

( 

18) 

( 

ID 

External 

Input  | 

19  M 

19 

External 

Output 

( 

19) 

1  ! 

20 

External 

Output 

( 

20) 

1 1 

21 

External 

Output 

( 

21) 

300  1  External  Output  (300) 


algeb 

EXPR 


INTERCONNECTION  FOR  SUPER-BLOCK  "CTRL" 


L 


<BUILD>  General  Algebraic  Equation  :  Kl 


Yl  =  U4*U1  +  U5*U2  *  U6*U3 ; 

Y2  =  U7.U1  +  U8*U2  -  U9*U3; 

Y3  =  U10.U1  -  U11*U2  +  U12*U3 
Y4  =  U13*U1  *  U14*U2  +  U15*U3 
Y5  =  U16*U1  -  U17*U2  *  U18«U3 


Constants  :  0  Parameters 

Inputs  :  18  Outputs 

<BUILD>  Integrator  of  Order  1 

GAIN 

1.0000D-02  1.0000D-02 

XO 

0.  0.  0. 

Inputs  :  3  Outputs  :  3 


Stacksize 

States 


3 

0 


IN  ERR 


1.0000D-02 


States 


<BUILD>  General  Algebraic  Equation  :  K2 


Yl  =  U4*U1  *  U5*U2  -  U6.U3; 

Y2  -  U7»l'l  4  U8*U2  *  U9-U3; 

Y3  =  U10*U1  *  U11*U2  *  U12*U3 
Y4  =  U13*U1  *  U14*U2  *  U15*U3 
Y5  -  U16*U1  *  U17.U2  *  U18*U3 


Constants  :  0  Parameters  :  0 

Inputs  :  18  Outputs  :  5 

<BUILD>  Summing  Junction  : 

SIGNS 

1 .  1 . 

Inputs  :  10  Outputs  :  5 


Stacksize  :  3 
States  :  0 


States  :  0 


E-2  5 


Block  location  :  1 


• 

INPUTS 

1! 

OUTPUTS 

From 

Name  Location 

To 

1  ! 

1  ! 

1  1 

From ; 

Name  Location 

To 

(  1) 

External 

Input 

1 

1 

1 ! 

1  ! 

5 

(  1) 

(  2) 

External 

Input 

2 

1  i 

2  : 

5 

(  2) 

e 

(  3) 

External 

Input 

3 

II 

3 

5 

(  3) 

(  4) 

External 

Input 

4 

1  1 

4  i 

5 

(  4) 

(  5) 

External 

Input 

5 

1  1 

5  ; 

5 

(  5) 

(  6) 

External 

Input 

6 

II 

(  7) 

External 

Input 

7 

|  | 

(  8) 

External 

Input 

8 

1 ! 

4p 

(  9) 

External 

Input 

9 

II 

(  io) 

External 

Input 

10 

1 1 

(  ID 

External 

Input 

11 

II 

(  12) 

External 

Input 

12 

i: 

(  13) 

External 

Input 

13 

1 1 

(  14) 

External 

Input 

14 

li 

i  ^ 

(  15) 

External 

Input 

15 

|  i 

(  16) 

External 

Input 

16 

li 

(  17) 

External 

Input 

17 

i 1 

(  18) 

External 

Input 

18 

1  ; 

Block  location 

:  3 

• 

INPUTS 

1  : 

OUTPUTS 

F  rom 

Name  Location 

To 

1  ' 

1 

From 

Name  Location 

To 

(  1) 

External 

Input 

1 

1 

1 

1  I 

K2  4 

(  1) 

(  2) 

External 

Input 

2 

1  i 

2 

K2  4 

(  2) 

Cl 

(  3) 

External 

Input 

3 

li 

3  : 

K2  4 

(  3) 

Block  location 

4 

INPUTS 

1  ! 

OUTPUTS 

£ 

F  rom 

Name  Location 

To 

1 

|  ■ 

From 

Name  Location 

To 

(  1) 

IN  ERR 

3 

1 

i  ! 

1 

5 

(  6) 

(  2) 

IN  ERR 

3 

2 

i  ' 

* 

2 

5 

(  7) 

(  3) 

IN  ERR 

3 

3 

j 

3 

5 

(  8) 

(  19) 

External 

Input 

4 

| 

4 

5 

(  9) 

(  2  j) 

External 

Input 

5 

| 

5 

5 

(  10) 

% 

(  21) 

External 

Input 

6 

1 

1 

! 

(  22) 

External 

Input 

7 

i 

W 


E-26 


a 


(  23) 
(  24) 
(  25) 
(  26) 
(  27) 
(  28) 
(  29) 
(  30) 
(  31) 
(  32) 
(  33) 


External 

External 

External 

External 

External 

External 

External 

External 

External 

External 

External 


Input 

Input 

Input 

Input 

Input 

Input 

Input 

Input 

Input 

Input 

Input 


8  || 
9  II 

10  I  ! 

11  U 

12  |  | 

13  I  : 

14  I  i 

15  |  : 

16  li 

17  M 

18  I  i 


Block  location  :  5 


INPUTS 


OUTPUTS 


From 

Name 

Location 

:  To  I 

From1 

Name  Location 

To 

( 

1) 

Kl 

1 

1 

:  i  ! 

External 

Output  ( 

1) 

( 

2) 

Kl 

1 

2  ! 

2  | 

External 

Output  ( 

2) 

( 

3) 

Kl 

1 

3 

3 

External 

Output  ( 

3) 

( 

4) 

Kl 

1 

4  I 

!  4 

External 

Output  ( 

4) 

( 

5) 

Kl 

1 

5 

5  : 

External 

Output  ( 

5) 

( 

1) 

K2 

4 

6 

( 

\ 

2) 

K2 

4 

7  ! 

( 

3) 

K2 

4 

8 

( 

4) 

K2 

4 

9 

( 

5) 

K2 

4 

10 

V  *  W"'- ' 


laZtLa! 


jt. 


INTERCONNECTION  FOR  SUPER-BLOCK  "B  MAT" 


10  <BUILD>  Gain  Table  Scheduler  :  BGAINS 

Switch  Tolerance  =  1.0000D-02 


At  least  26  more  lines.  Enter  blank  to  continue  output:  1 


# 

Inputs  : 

6 

Outputs  :  8 

States  :  0 

Block  location 

:  1 

INPUTS 

|  OUTPUTS 

From  Name  Location  I  To  Ij  From!  Name  Location  To 


( 

6) 

External 

Input  | 

1 

1 

External 

Output 

( 

1) 

( 

1) 

External 

Input  I 

2 

2 

External 

Output 

( 

2) 

( 

2) 

External 

Input  I 

3  ; 

3 

External 

Output 

( 

3) 

( 

3) 

External 

Input 

4  :  1 

4 

:  External 

Output 

( 

4) 

( 

4) 

External 

Input  : 

5 

5 

External 

Output 

( 

5) 

( 

5) 

External 

Input  ■ 

6 

6 

|  External 

Output 

( 

6) 

,  ! 

7 

External 

Output 

( 

7) 

:  1 

8 

External 

Output 

( 

8) 

E  d  :  1 1  n  g 


A  MAT 


(  C  on  t  i 


) 


e 


3 

c 

j 


& 


INTECONNECTION  FOR  SUPER-BLOCK  "A  MAT* 

<BUILD>  Gain  Table  Scheduler  :  A’S 
Switch  Tolerance  =  1.0000D-02 


GAIN  TABLE 


COLUMNS 

1  THRU  6 

V 

0 . OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

1 .OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

v 

-3 . 21830*01 

-5 . 6009D-02 

3.8291D-01 

-3 . 0138D-01 

0. OOOOD-OO 

0.  OOOOD-OO 

-1 .1000D-03 

4 . 5971D-05 

-1 .4845D-00 

9 . 9480D-01 

0. OOOOD-OO 

0. OOOOD-OO 

3.0000D-04 

-2. 1010D-03 

4.2717D-00 

-7 . 7720D-01 

0. OOOOD-OO 

0. OOOOD-OO 

* 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

1 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

3 . 4500D-02 

-3 . 4536D-01 

■ 

m 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

-5 . 5253D-01 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

7 . 2370D-00 

COLUMNS 

7  THRU  8 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

0. OOOOD-OO 

f, 

k 

0. OOOOD-OO 

0. OOOOD-OO 

r 

0. OOOOD-OO 

0. OOOOD-OO 

fr 

1  OOOOD-OO 

0. OOOOD-OO 

3 . 2600D-02 

-9 . 9760D-01 

i* 

-2 . 8004D-00 

1 . 4570D-01 

1 

2 . 3200D-02 

-3 . 6250D-01 

& 


k 


BREAKPOINT  - 

5 . OOOOD-Ol 

Inputs  :  9 

Outputs  :  8 

States  :  0 

Block  location  :  1 

INPUTS 

1 1  OUTPUTS 

From 

Name  Location  | 

To  ' 

From 

Name  Location 

To 

( 

9) 

External 

Input  | 

1  ! 

1 

External 

Output  ( 

1) 

( 

1) 

External 

Input  i 

2 

2 

External 

Output  ( 

2) 

( 

2) 

External 

Input  j 

3  , 

3 

External 

Output  ( 

3) 

( 

3) 

External 

Input  | 

4 

4 

External 

Output  ( 

4) 

( 

4) 

External 

Input  | 

5 

5 

External 

Output  ( 

5) 

( 

5) 

External 

Input  ! 

6 

6 

External 

Output  ( 

6) 

( 

6) 

External 

Input  ! 

7 

7 

External  Output  ( 

7) 

( 

7) 

External 

Input  1 

8 

8 

External 

Output  ( 

8) 

( 

8) 

External 

Input 

6 

E— 3 1 


INTERCONNECTION  FOR  SUPER-BLOCK  "LMTINT" 


<Bl'ILD>  Summing  Junction  : 

SIGNS 

1 .  -1 . 

Inputs  :  8  Outputs  :  4  States  :  0 


<Bl'ILD>  Integrator  of  Order  1  :  S  INT 
GAIN 

1.  1.  1.  1. 

XO 

0.  0.  0.  0. 

Inputs  :  4  Outputs  :  4  States  :  4 

<BUILD>  User  Code  Function  Block  #3  :  R/CANC 

This  block  has  direct  feed-through  terms  (dY/dU  <>  0) 

RPAR 

COLUMNS  1  THRU  6 

-3 . 9724D*03  4.7543D+03  -3.9724D-03  4.7578D+03  -3.1416D+03 

COLUMNS  7  THRU  8 

-3 . 1416D-03  3.8397D-03 

IPAR 

4.  1  . 


3 . 8397D+03 


Inputs  :  9 


Outputs  :  5 


States  :  0 


e 


Block  location 

:  1 

INPUTS 

1 

1  ! 

OUTPUTS 

From 

Name  Location 

1 

To 

i  1 

1 1 
■  i 

From ; 

Name  Location 

To 

(  1) 

External  Input 

i 

i 

1 

!  I 

1  , 

S  INT  2  ( 

1) 

1 

!  1 

1 

External  Output  ( 

5) 

* 

(  2) 

External  Input 

1 

2 

!  1 

2  ; 

S  INT  2  ( 

2) 

1 

1 

1 

External  Output  ( 

6) 

(  3) 

External  Input 

1 

3 

;  i 

3 

S  INT  2  ( 

3) 

1 

!  i 

i 

External  Output  ( 

7) 

(  4) 

External  Input 

1 

4 

1  1 

4  I 

S  INT  2  ( 

4) 

1 

i  i 

i 

External  Output  ( 

8) 

# 

(  1) 

R/CANC  3 

1 

5 

1  1 

(  2) 

R/CANC  3 

1 

6 

1  1 

(  3) 

R/CANC  3 

1 

7 

1  i 

(  4) 

R/CANC  3 

1 

8 

1  1 

* 

Block  location 

2 

INPUTS 

1  1 

1  i 

OUTPUTS 

From 

Name  Location 

1 

To 

1  1 
II 

1  | 

From ! 

Name  Location 

To 

(  1) 

1 

1 

1 

!  1 

1  1 

1  1 

R/CANC  3  ( 

2) 

# 

1 

1  I 

1 

External  Output  ( 

1) 

(  2) 

1 

| 

i 

2 

|  I 

2  ! 

R/CANC  3  ( 

3) 

1 

1 

1  • 
t  i 

i 

External  Output  ( 

2) 

(  3) 

1 

1 

3 

1  ' 

3  1 

R/CANC  3  ( 

4) 

1 

1  ! 

1 

External  Output  ( 

3) 

(  4) 

1 

1 

4 

1  i 

4  i 

R/CANC  3  ( 

5) 

4# 

i 

1  ; 

! 

External  Output  ( 

4) 

Block  location 

3 

INPUTS 

1  ; 

OUTPUTS 

U 


From 

Name  Location 

1 

To  | 

i 

|  From 

Name  Location 

To 

( 

5) 

External 

Input 

1 

1  : 

1  “  ~  * 

f  1 

1 

(  5) 

( 

1) 

S  INT 

2 

1 

2  ! 

!  2 

1 

(  6) 

( 

2) 

S  INT 

2 

1 

3  ! 

!  3 

1 

(  7) 

( 

3) 

S  INT 

2 

1 

4  I 

1  4 

1 

(  8) 

( 

4) 

S  INT 

2 

1 

5  l 

5 

( 

1) 

External 

Input 

1 

6  1 

i 

( 

2) 

External 

Input 

1 

7  1 

l 

1 

( 

3) 

External 

Input 

1 

8 

i 

( 

4) 

External 

Input 

1 

S  I 

i 

1 

E-34 


c 


INTERCONNECTION  FOR  SUPER-BLOCK  "SERV02" 


<BUILD> 

Linear  Dy 

namic  System 

:  EL  ] 

S 

-92. 

-1440. 

1 

1 . 

0. 

0 

0. 

1440. 

0 

XO 

0.  0. 


Inputs  :  1 


Outputs  :  1  States  :  2 


<BUILD> 

Linear 

Dynamic  System  : 

:  EL  R 

S 

-92. 

-1440. 

1 

1 . 

0. 

0 

0. 

1440. 

0 

XO 

0.  0. 

Inputs  :  1  Outputs  :  1  States  :  2 


<BUILD> 

Linear 

Dynamic  System 

:  FL  : 

S 

-92. 

-1440. 

1 

1 . 

0. 

0 

0. 

1440. 

0 

XO 

0.  0. 


Inputs 


Outputs  :  1  States  :  2 


E-36 

| 

i 


<BUILD> 

Linear 

Dynamic  System 

:  FL  : 

S 

-92. 

-1440. 

1 

1 . 

0. 

0 

0. 

1440. 

0 

xo 

0.  0. 

Inputs  :  1  Outputs  :  1  States  :  2 

<BUILD>  Linear  Dynamic  System  :  £N  LAG 
S 

-1.  1. 

1 .  0. 


XO 

0. 

Inputs  :  1  Outputs  :  1  States  :  1 


Block 

location 

:  1 

INPUTS 

1 

! 

OUTPUTS 
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